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_BSS_AC_ACCESS_DELAY: 1375 bss_entry->bcn_wapi_ie = 1376 (struct ieee_types_generic *) current_ptr; 1377 bss_entry->wapi_offset = (u16) (current_ptr - 1378 bss_entry->beacon_buf); 1379 break; 1380 case WLAN_EID_HT_CAPABILITY: 1381 bss_entry->bcn_ht_cap = (struct ieee80211_ht_cap *) 1382 (current_ptr + 1383 sizeof(struct ieee_types_header)); 1384 bss_entry->ht_cap_offset = (u16) (current_ptr + 1385 sizeof(struct ieee_types_header) - 1386 bss_entry->beacon_buf); 1387 break; 1388 case WLAN_EID_HT_OPERATION: 1389 bss_entry->bcn_ht_oper = 1390 (struct ieee80211_ht_operation *)(current_ptr + 1391 sizeof(struct ieee_types_header)); 1392 bss_entry->ht_info_offset = (u16) (current_ptr + 1393 sizeof(struct ieee_types_header) - 1394 bss_entry->beacon_buf); 1395 break; 1396 case WLAN_EID_VHT_CAPABILITY: 1397 bss_entry->disable_11ac = false; 1398 bss_entry->bcn_vht_cap = 1399 (void *)(current_ptr + 1400 sizeof(struct ieee_types_header)); 1401 bss_entry->vht_cap_offset = 1402 (u16)((u8 *)bss_entry->bcn_vht_cap - 1403 bss_entry->beacon_buf); 1404 break; 1405 case WLAN_EID_VHT_OPERATION: 1406 bss_entry->bcn_vht_oper = 1407 (void *)(current_ptr + 1408 sizeof(struct ieee_types_header)); 1409 bss_entry->vht_info_offset = 1410 (u16)((u8 *)bss_entry->bcn_vht_oper - 1411 bss_entry->beacon_buf); 1412 break; 1413 case WLAN_EID_BSS_COEX_2040: 1414 bss_entry->bcn_bss_co_2040 = current_ptr; 1415 bss_entry->bss_co_2040_offset = 1416 (u16) (current_ptr - bss_entry->beacon_buf); 1417 break; 1418 case WLAN_EID_EXT_CAPABILITY: 1419 bss_entry->bcn_ext_cap = current_ptr; 1420 bss_entry->ext_cap_offset = 1421 (u16) (current_ptr - bss_entry->beacon_buf); 1422 break; 1423 case WLAN_EID_OPMODE_NOTIF: 1424 bss_entry->oper_mode = (void *)current_ptr; 1425 bss_entry->oper_mode_offset = 1426 (u16)((u8 *)bss_entry->oper_mode - 1427 bss_entry->beacon_buf); 1428 break; 1429 default: 1430 break; 1431 } 1432 1433 current_ptr += total_ie_len; 1434 bytes_left -= total_ie_len; 1435 1436 } /* while (bytes_left > 2) */ 1437 return 0; 1438 } 1439 1440 /* 1441 * This function converts radio type scan parameter to a band configuration 1442 * to be used in join command. 1443 */ 1444 static u8 1445 mwifiex_radio_type_to_band(u8 radio_type) 1446 { 1447 switch (radio_type) { 1448 case HostCmd_SCAN_RADIO_TYPE_A: 1449 return BAND_A; 1450 case HostCmd_SCAN_RADIO_TYPE_BG: 1451 default: 1452 return BAND_G; 1453 } 1454 } 1455 1456 /* 1457 * This is an internal function used to start a scan based on an input 1458 * configuration. 1459 * 1460 * This uses the input user scan configuration information when provided in 1461 * order to send the appropriate scan commands to firmware to populate or 1462 * update the internal driver scan table. 1463 */ 1464 int mwifiex_scan_networks(struct mwifiex_private *priv, 1465 const struct mwifiex_user_scan_cfg *user_scan_in) 1466 { 1467 int ret; 1468 struct mwifiex_adapter *adapter = priv->adapter; 1469 struct cmd_ctrl_node *cmd_node; 1470 union mwifiex_scan_cmd_config_tlv *scan_cfg_out; 1471 struct mwifiex_ie_types_chan_list_param_set *chan_list_out; 1472 struct mwifiex_chan_scan_param_set *scan_chan_list; 1473 u8 filtered_scan; 1474 u8 scan_current_chan_only; 1475 u8 max_chan_per_scan; 1476 1477 if (adapter->scan_processing) { 1478 mwifiex_dbg(adapter, WARN, 1479 "cmd: Scan already in process...\n"); 1480 return -EBUSY; 1481 } 1482 1483 if (priv->scan_block) { 1484 mwifiex_dbg(adapter, WARN, 1485 "cmd: Scan is blocked during association...\n"); 1486 return -EBUSY; 1487 } 1488 1489 if (test_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags) || 1490 test_bit(MWIFIEX_IS_CMD_TIMEDOUT, &adapter->work_flags)) { 1491 mwifiex_dbg(adapter, ERROR, 1492 "Ignore scan. Card removed or firmware in bad state\n"); 1493 return -EFAULT; 1494 } 1495 1496 spin_lock_bh(&adapter->mwifiex_cmd_lock); 1497 adapter->scan_processing = true; 1498 spin_unlock_bh(&adapter->mwifiex_cmd_lock); 1499 1500 scan_cfg_out = kzalloc(sizeof(union mwifiex_scan_cmd_config_tlv), 1501 GFP_KERNEL); 1502 if (!scan_cfg_out) { 1503 ret = -ENOMEM; 1504 goto done; 1505 } 1506 1507 scan_chan_list = kcalloc(MWIFIEX_USER_SCAN_CHAN_MAX, 1508 sizeof(struct mwifiex_chan_scan_param_set), 1509 GFP_KERNEL); 1510 if (!scan_chan_list) { 1511 kfree(scan_cfg_out); 1512 ret = -ENOMEM; 1513 goto done; 1514 } 1515 1516 mwifiex_config_scan(priv, user_scan_in, &scan_cfg_out->config, 1517 &chan_list_out, scan_chan_list, &max_chan_per_scan, 1518 &filtered_scan, &scan_current_chan_only); 1519 1520 ret = mwifiex_scan_channel_list(priv, max_chan_per_scan, filtered_scan, 1521 &scan_cfg_out->config, chan_list_out, 1522 scan_chan_list); 1523 1524 /* Get scan command from scan_pending_q and put to cmd_pending_q */ 1525 if (!ret) { 1526 spin_lock_bh(&adapter->scan_pending_q_lock); 1527 if (!list_empty(&adapter->scan_pending_q)) { 1528 cmd_node = list_first_entry(&adapter->scan_pending_q, 1529 struct cmd_ctrl_node, list); 1530 list_del(&cmd_node->list); 1531 spin_unlock_bh(&adapter->scan_pending_q_lock); 1532 mwifiex_insert_cmd_to_pending_q(adapter, cmd_node); 1533 queue_work(adapter->workqueue, &adapter->main_work); 1534 1535 /* Perform internal scan synchronously */ 1536 if (!priv->scan_request) { 1537 mwifiex_dbg(adapter, INFO, 1538 "wait internal scan\n"); 1539 mwifiex_wait_queue_complete(adapter, cmd_node); 1540 } 1541 } else { 1542 spin_unlock_bh(&adapter->scan_pending_q_lock); 1543 } 1544 } 1545 1546 kfree(scan_cfg_out); 1547 kfree(scan_chan_list); 1548 done: 1549 if (ret) { 1550 spin_lock_bh(&adapter->mwifiex_cmd_lock); 1551 adapter->scan_processing = false; 1552 spin_unlock_bh(&adapter->mwifiex_cmd_lock); 1553 } 1554 return ret; 1555 } 1556 1557 /* 1558 * This function prepares a scan command to be sent to the firmware. 1559 * 1560 * This uses the scan command configuration sent to the command processing 1561 * module in command preparation stage to configure a scan command structure 1562 * to send to firmware. 1563 * 1564 * The fixed fields specifying the BSS type and BSSID filters as well as a 1565 * variable number/length of TLVs are sent in the command to firmware. 1566 * 1567 * Preparation also includes - 1568 * - Setting command ID, and proper size 1569 * - Ensuring correct endian-ness 1570 */ 1571 int mwifiex_cmd_802_11_scan(struct host_cmd_ds_command *cmd, 1572 struct mwifiex_scan_cmd_config *scan_cfg) 1573 { 1574 struct host_cmd_ds_802_11_scan *scan_cmd = &cmd->params.scan; 1575 1576 /* Set fixed field variables in scan command */ 1577 scan_cmd->bss_mode = scan_cfg->bss_mode; 1578 memcpy(scan_cmd->bssid, scan_cfg->specific_bssid, 1579 sizeof(scan_cmd->bssid)); 1580 memcpy(scan_cmd->tlv_buffer, scan_cfg->tlv_buf, scan_cfg->tlv_buf_len); 1581 1582 cmd->command = cpu_to_le16(HostCmd_CMD_802_11_SCAN); 1583 1584 /* Size is equal to the sizeof(fixed portions) + the TLV len + header */ 1585 cmd->size = cpu_to_le16((u16) (sizeof(scan_cmd->bss_mode) 1586 + sizeof(scan_cmd->bssid) 1587 + scan_cfg->tlv_buf_len + S_DS_GEN)); 1588 1589 return 0; 1590 } 1591 1592 /* 1593 * This function checks compatibility of requested network with current 1594 * driver settings. 1595 */ 1596 int mwifiex_check_network_compatibility(struct mwifiex_private *priv, 1597 struct mwifiex_bssdescriptor *bss_desc) 1598 { 1599 int ret = -1; 1600 1601 if (!bss_desc) 1602 return -1; 1603 1604 if ((mwifiex_get_cfp(priv, (u8) bss_desc->bss_band, 1605 (u16) bss_desc->channel, 0))) { 1606 switch (priv->bss_mode) { 1607 case NL80211_IFTYPE_STATION: 1608 case NL80211_IFTYPE_ADHOC: 1609 ret = mwifiex_is_network_compatible(priv, bss_desc, 1610 priv->bss_mode); 1611 if (ret) 1612 mwifiex_dbg(priv->adapter, ERROR, 1613 "Incompatible network settings\n"); 1614 break; 1615 default: 1616 ret = 0; 1617 } 1618 } 1619 1620 return ret; 1621 } 1622 1623 /* This function checks if SSID string contains all zeroes or length is zero */ 1624 static bool mwifiex_is_hidden_ssid(struct cfg80211_ssid *ssid) 1625 { 1626 int idx; 1627 1628 for (idx = 0; idx < ssid->ssid_len; idx++) { 1629 if (ssid->ssid[idx]) 1630 return false; 1631 } 1632 1633 return true; 1634 } 1635 1636 /* This function checks if any hidden SSID found in passive scan channels 1637 * and save those channels for specific SSID active scan 1638 */ 1639 static int mwifiex_save_hidden_ssid_channels(struct mwifiex_private *priv, 1640 struct cfg80211_bss *bss) 1641 { 1642 struct mwifiex_bssdescriptor *bss_desc; 1643 int ret; 1644 int chid; 1645 1646 /* Allocate and fill new bss descriptor */ 1647 bss_desc = kzalloc(sizeof(*bss_desc), GFP_KERNEL); 1648 if (!bss_desc) 1649 return -ENOMEM; 1650 1651 ret = mwifiex_fill_new_bss_desc(priv, bss, bss_desc); 1652 if (ret) 1653 goto done; 1654 1655 if (mwifiex_is_hidden_ssid(&bss_desc->ssid)) { 1656 mwifiex_dbg(priv->adapter, INFO, "found hidden SSID\n"); 1657 for (chid = 0 ; chid < MWIFIEX_USER_SCAN_CHAN_MAX; chid++) { 1658 if (priv->hidden_chan[chid].chan_number == 1659 bss->channel->hw_value) 1660 break; 1661 1662 if (!priv->hidden_chan[chid].chan_number) { 1663 priv->hidden_chan[chid].chan_number = 1664 bss->channel->hw_value; 1665 priv->hidden_chan[chid].radio_type = 1666 bss->channel->band; 1667 priv->hidden_chan[chid].scan_type = 1668 MWIFIEX_SCAN_TYPE_ACTIVE; 1669 break; 1670 } 1671 } 1672 } 1673 1674 done: 1675 /* beacon_ie buffer was allocated in function 1676 * mwifiex_fill_new_bss_desc(). Free it now. 1677 */ 1678 kfree(bss_desc->beacon_buf); 1679 kfree(bss_desc); 1680 return 0; 1681 } 1682 1683 static int mwifiex_update_curr_bss_params(struct mwifiex_private *priv, 1684 struct cfg80211_bss *bss) 1685 { 1686 struct mwifiex_bssdescriptor *bss_desc; 1687 int ret; 1688 1689 /* Allocate and fill new bss descriptor */ 1690 bss_desc = kzalloc(sizeof(struct mwifiex_bssdescriptor), GFP_KERNEL); 1691 if (!bss_desc) 1692 return -ENOMEM; 1693 1694 ret = mwifiex_fill_new_bss_desc(priv, bss, bss_desc); 1695 if (ret) 1696 goto done; 1697 1698 ret = mwifiex_check_network_compatibility(priv, bss_desc); 1699 if (ret) 1700 goto done; 1701 1702 spin_lock_bh(&priv->curr_bcn_buf_lock); 1703 /* Make a copy of current BSSID descriptor */ 1704 memcpy(&priv->curr_bss_params.bss_descriptor, bss_desc, 1705 sizeof(priv->curr_bss_params.bss_descriptor)); 1706 1707 /* The contents of beacon_ie will be copied to its own buffer 1708 * in mwifiex_save_curr_bcn() 1709 */ 1710 mwifiex_save_curr_bcn(priv); 1711 spin_unlock_bh(&priv->curr_bcn_buf_lock); 1712 1713 done: 1714 /* beacon_ie buffer was allocated in function 1715 * mwifiex_fill_new_bss_desc(). Free it now. 1716 */ 1717 kfree(bss_desc->beacon_buf); 1718 kfree(bss_desc); 1719 return 0; 1720 } 1721 1722 static int 1723 mwifiex_parse_single_response_buf(struct mwifiex_private *priv, u8 **bss_info, 1724 u32 *bytes_left, u64 fw_tsf, u8 *radio_type, 1725 bool ext_scan, s32 rssi_val) 1726 { 1727 struct mwifiex_adapter *adapter = priv->adapter; 1728 struct mwifiex_chan_freq_power *cfp; 1729 struct cfg80211_bss *bss; 1730 u8 bssid[ETH_ALEN]; 1731 s32 rssi; 1732 const u8 *ie_buf; 1733 size_t ie_len; 1734 u16 channel = 0; 1735 u16 beacon_size = 0; 1736 u32 curr_bcn_bytes; 1737 u32 freq; 1738 u16 beacon_period; 1739 u16 cap_info_bitmap; 1740 u8 *current_ptr; 1741 u64 timestamp; 1742 struct mwifiex_fixed_bcn_param *bcn_param; 1743 struct mwifiex_bss_priv *bss_priv; 1744 1745 if (*bytes_left >= sizeof(beacon_size)) { 1746 /* Extract & convert beacon size from command buffer */ 1747 beacon_size = get_unaligned_le16((*bss_info)); 1748 *bytes_left -= sizeof(beacon_size); 1749 *bss_info += sizeof(beacon_size); 1750 } 1751 1752 if (!beacon_size || beacon_size > *bytes_left) { 1753 *bss_info += *bytes_left; 1754 *bytes_left = 0; 1755 return -EFAULT; 1756 } 1757 1758 /* Initialize the current working beacon pointer for this BSS 1759 * iteration 1760 */ 1761 current_ptr = *bss_info; 1762 1763 /* Advance the return beacon pointer past the current beacon */ 1764 *bss_info += beacon_size; 1765 *bytes_left -= beacon_size; 1766 1767 curr_bcn_bytes = beacon_size; 1768 1769 /* First 5 fields are bssid, RSSI(for legacy scan only), 1770 * time stamp, beacon interval, and capability information 1771 */ 1772 if (curr_bcn_bytes < ETH_ALEN + sizeof(u8) + 1773 sizeof(struct mwifiex_fixed_bcn_param)) { 1774 mwifiex_dbg(adapter, ERROR, 1775 "InterpretIE: not enough bytes left\n"); 1776 return -EFAULT; 1777 } 1778 1779 memcpy(bssid, current_ptr, ETH_ALEN); 1780 current_ptr += ETH_ALEN; 1781 curr_bcn_bytes -= ETH_ALEN; 1782 1783 if (!ext_scan) { 1784 rssi = (s32) *current_ptr; 1785 rssi = (-rssi) * 100; /* Convert dBm to mBm */ 1786 current_ptr += sizeof(u8); 1787 curr_bcn_bytes -= sizeof(u8); 1788 mwifiex_dbg(adapter, INFO, 1789 "info: InterpretIE: RSSI=%d\n", rssi); 1790 } else { 1791 rssi = rssi_val; 1792 } 1793 1794 bcn_param = (struct mwifiex_fixed_bcn_param *)current_ptr; 1795 current_ptr += sizeof(*bcn_param); 1796 curr_bcn_bytes -= sizeof(*bcn_param); 1797 1798 timestamp = le64_to_cpu(bcn_param->timestamp); 1799 beacon_period = le16_to_cpu(bcn_param->beacon_period); 1800 1801 cap_info_bitmap = le16_to_cpu(bcn_param->cap_info_bitmap); 1802 mwifiex_dbg(adapter, INFO, 1803 "info: InterpretIE: capabilities=0x%X\n", 1804 cap_info_bitmap); 1805 1806 /* Rest of the current buffer are IE's */ 1807 ie_buf = current_ptr; 1808 ie_len = curr_bcn_bytes; 1809 mwifiex_dbg(adapter, INFO, 1810 "info: InterpretIE: IELength for this AP = %d\n", 1811 curr_bcn_bytes); 1812 1813 while (curr_bcn_bytes >= sizeof(struct ieee_types_header)) { 1814 u8 element_id, element_len; 1815 1816 element_id = *current_ptr; 1817 element_len = *(current_ptr + 1); 1818 if (curr_bcn_bytes < element_len + 1819 sizeof(struct ieee_types_header)) { 1820 mwifiex_dbg(adapter, ERROR, 1821 "%s: bytes left < IE length\n", __func__); 1822 return -EFAULT; 1823 } 1824 if (element_id == WLAN_EID_DS_PARAMS) { 1825 channel = *(current_ptr + 1826 sizeof(struct ieee_types_header)); 1827 break; 1828 } 1829 1830 current_ptr += element_len + sizeof(struct ieee_types_header); 1831 curr_bcn_bytes -= element_len + 1832 sizeof(struct ieee_types_header); 1833 } 1834 1835 if (channel) { 1836 struct ieee80211_channel *chan; 1837 u8 band; 1838 1839 /* Skip entry if on csa closed channel */ 1840 if (channel == priv->csa_chan) { 1841 mwifiex_dbg(adapter, WARN, 1842 "Dropping entry on csa closed channel\n"); 1843 return 0; 1844 } 1845 1846 band = BAND_G; 1847 if (radio_type) 1848 band = mwifiex_radio_type_to_band(*radio_type & 1849 (BIT(0) | BIT(1))); 1850 1851 cfp = mwifiex_get_cfp(priv, band, channel, 0); 1852 1853 freq = cfp ? cfp->freq : 0; 1854 1855 chan = ieee80211_get_channel(priv->wdev.wiphy, freq); 1856 1857 if (chan && !(chan->flags & IEEE80211_CHAN_DISABLED)) { 1858 bss = cfg80211_inform_bss(priv->wdev.wiphy, 1859 chan, CFG80211_BSS_FTYPE_UNKNOWN, 1860 bssid, timestamp, 1861 cap_info_bitmap, beacon_period, 1862 ie_buf, ie_len, rssi, GFP_ATOMIC); 1863 if (bss) { 1864 bss_priv = (struct mwifiex_bss_priv *)bss->priv; 1865 bss_priv->band = band; 1866 bss_priv->fw_tsf = fw_tsf; 1867 if (priv->media_connected && 1868 !memcmp(bssid, priv->curr_bss_params. 1869 bss_descriptor.mac_address, 1870 ETH_ALEN)) 1871 mwifiex_update_curr_bss_params(priv, 1872 bss); 1873 1874 if ((chan->flags & IEEE80211_CHAN_RADAR) || 1875 (chan->flags & IEEE80211_CHAN_NO_IR)) { 1876 mwifiex_dbg(adapter, INFO, 1877 "radar or passive channel %d\n", 1878 channel); 1879 mwifiex_save_hidden_ssid_channels(priv, 1880 bss); 1881 } 1882 1883 cfg80211_put_bss(priv->wdev.wiphy, bss); 1884 } 1885 } 1886 } else { 1887 mwifiex_dbg(adapter, WARN, "missing BSS channel IE\n"); 1888 } 1889 1890 return 0; 1891 } 1892 1893 static void mwifiex_complete_scan(struct mwifiex_private *priv) 1894 { 1895 struct mwifiex_adapter *adapter = priv->adapter; 1896 1897 adapter->survey_idx = 0; 1898 if (adapter->curr_cmd->wait_q_enabled) { 1899 adapter->cmd_wait_q.status = 0; 1900 if (!priv->scan_request) { 1901 mwifiex_dbg(adapter, INFO, 1902 "complete internal scan\n"); 1903 mwifiex_complete_cmd(adapter, adapter->curr_cmd); 1904 } 1905 } 1906 } 1907 1908 /* This function checks if any hidden SSID found in passive scan channels 1909 * and do specific SSID active scan for those channels 1910 */ 1911 static int 1912 mwifiex_active_scan_req_for_passive_chan(struct mwifiex_private *priv) 1913 { 1914 int ret; 1915 struct mwifiex_adapter *adapter = priv->adapter; 1916 u8 id = 0; 1917 struct mwifiex_user_scan_cfg *user_scan_cfg; 1918 1919 if (adapter->active_scan_triggered || !priv->scan_request || 1920 priv->scan_aborting) { 1921 adapter->active_scan_triggered = false; 1922 return 0; 1923 } 1924 1925 if (!priv->hidden_chan[0].chan_number) { 1926 mwifiex_dbg(adapter, INFO, "No BSS with hidden SSID found on DFS channels\n"); 1927 return 0; 1928 } 1929 user_scan_cfg = kzalloc(sizeof(*user_scan_cfg), GFP_KERNEL); 1930 1931 if (!user_scan_cfg) 1932 return -ENOMEM; 1933 1934 for (id = 0; id < MWIFIEX_USER_SCAN_CHAN_MAX; id++) { 1935 if (!priv->hidden_chan[id].chan_number) 1936 break; 1937 memcpy(&user_scan_cfg->chan_list[id], 1938 &priv->hidden_chan[id], 1939 sizeof(struct mwifiex_user_scan_chan)); 1940 } 1941 1942 adapter->active_scan_triggered = true; 1943 if (priv->scan_request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) 1944 ether_addr_copy(user_scan_cfg->random_mac, 1945 priv->scan_request->mac_addr); 1946 user_scan_cfg->num_ssids = priv->scan_request->n_ssids; 1947 user_scan_cfg->ssid_list = priv->scan_request->ssids; 1948 1949 ret = mwifiex_scan_networks(priv, user_scan_cfg); 1950 kfree(user_scan_cfg); 1951 1952 memset(&priv->hidden_chan, 0, sizeof(priv->hidden_chan)); 1953 1954 if (ret) { 1955 dev_err(priv->adapter->dev, "scan failed: %d\n", ret); 1956 return ret; 1957 } 1958 1959 return 0; 1960 } 1961 static void mwifiex_check_next_scan_command(struct mwifiex_private *priv) 1962 { 1963 struct mwifiex_adapter *adapter = priv->adapter; 1964 struct cmd_ctrl_node *cmd_node; 1965 1966 spin_lock_bh(&adapter->scan_pending_q_lock); 1967 if (list_empty(&adapter->scan_pending_q)) { 1968 spin_unlock_bh(&adapter->scan_pending_q_lock); 1969 1970 spin_lock_bh(&adapter->mwifiex_cmd_lock); 1971 adapter->scan_processing = false; 1972 spin_unlock_bh(&adapter->mwifiex_cmd_lock); 1973 1974 mwifiex_active_scan_req_for_passive_chan(priv); 1975 1976 if (!adapter->ext_scan) 1977 mwifiex_complete_scan(priv); 1978 1979 if (priv->scan_request) { 1980 struct cfg80211_scan_info info = { 1981 .aborted = false, 1982 }; 1983 1984 mwifiex_dbg(adapter, INFO, 1985 "info: notifying scan done\n"); 1986 cfg80211_scan_done(priv->scan_request, &info); 1987 priv->scan_request = NULL; 1988 priv->scan_aborting = false; 1989 } else { 1990 priv->scan_aborting = false; 1991 mwifiex_dbg(adapter, INFO, 1992 "info: scan already aborted\n"); 1993 } 1994 } else if ((priv->scan_aborting && !priv->scan_request) || 1995 priv->scan_block) { 1996 spin_unlock_bh(&adapter->scan_pending_q_lock); 1997 1998 mwifiex_cancel_pending_scan_cmd(adapter); 1999 2000 spin_lock_bh(&adapter->mwifiex_cmd_lock); 2001 adapter->scan_processing = false; 2002 spin_unlock_bh(&adapter->mwifiex_cmd_lock); 2003 2004 if (!adapter->active_scan_triggered) { 2005 if (priv->scan_request) { 2006 struct cfg80211_scan_info info = { 2007 .aborted = true, 2008 }; 2009 2010 mwifiex_dbg(adapter, INFO, 2011 "info: aborting scan\n"); 2012 cfg80211_scan_done(priv->scan_request, &info); 2013 priv->scan_request = NULL; 2014 priv->scan_aborting = false; 2015 } else { 2016 priv->scan_aborting = false; 2017 mwifiex_dbg(adapter, INFO, 2018 "info: scan already aborted\n"); 2019 } 2020 } 2021 } else { 2022 /* Get scan command from scan_pending_q and put to 2023 * cmd_pending_q 2024 */ 2025 cmd_node = list_first_entry(&adapter->scan_pending_q, 2026 struct cmd_ctrl_node, list); 2027 list_del(&cmd_node->list); 2028 spin_unlock_bh(&adapter->scan_pending_q_lock); 2029 mwifiex_insert_cmd_to_pending_q(adapter, cmd_node); 2030 } 2031 2032 return; 2033 } 2034 2035 void mwifiex_cancel_scan(struct mwifiex_adapter *adapter) 2036 { 2037 struct mwifiex_private *priv; 2038 int i; 2039 2040 mwifiex_cancel_pending_scan_cmd(adapter); 2041 2042 if (adapter->scan_processing) { 2043 spin_lock_bh(&adapter->mwifiex_cmd_lock); 2044 adapter->scan_processing = false; 2045 spin_unlock_bh(&adapter->mwifiex_cmd_lock); 2046 for (i = 0; i < adapter->priv_num; i++) { 2047 priv = adapter->priv[i]; 2048 if (!priv) 2049 continue; 2050 if (priv->scan_request) { 2051 struct cfg80211_scan_info info = { 2052 .aborted = true, 2053 }; 2054 2055 mwifiex_dbg(adapter, INFO, 2056 "info: aborting scan\n"); 2057 cfg80211_scan_done(priv->scan_request, &info); 2058 priv->scan_request = NULL; 2059 priv->scan_aborting = false; 2060 } 2061 } 2062 } 2063 } 2064 2065 /* 2066 * This function handles the command response of scan. 2067 * 2068 * The response buffer for the scan command has the following 2069 * memory layout: 2070 * 2071 * .-------------------------------------------------------------. 2072 * | Header (4 * sizeof(t_u16)): Standard command response hdr | 2073 * .-------------------------------------------------------------. 2074 * | BufSize (t_u16) : sizeof the BSS Description data | 2075 * .-------------------------------------------------------------. 2076 * | NumOfSet (t_u8) : Number of BSS Descs returned | 2077 * .-------------------------------------------------------------. 2078 * | BSSDescription data (variable, size given in BufSize) | 2079 * .-------------------------------------------------------------. 2080 * | TLV data (variable, size calculated using Header->Size, | 2081 * | BufSize and sizeof the fixed fields above) | 2082 * .-------------------------------------------------------------. 2083 */ 2084 int mwifiex_ret_802_11_scan(struct mwifiex_private *priv, 2085 struct host_cmd_ds_command *resp) 2086 { 2087 int ret = 0; 2088 struct mwifiex_adapter *adapter = priv->adapter; 2089 struct host_cmd_ds_802_11_scan_rsp *scan_rsp; 2090 struct mwifiex_ie_types_data *tlv_data; 2091 struct mwifiex_ie_types_tsf_timestamp *tsf_tlv; 2092 u8 *bss_info; 2093 u32 scan_resp_size; 2094 u32 bytes_left; 2095 u32 idx; 2096 u32 tlv_buf_size; 2097 struct mwifiex_ie_types_chan_band_list_param_set *chan_band_tlv; 2098 struct chan_band_param_set *chan_band; 2099 u8 is_bgscan_resp; 2100 __le64 fw_tsf = 0; 2101 u8 *radio_type; 2102 struct cfg80211_wowlan_nd_match *pmatch; 2103 struct cfg80211_sched_scan_request *nd_config = NULL; 2104 2105 is_bgscan_resp = (le16_to_cpu(resp->command) 2106 == HostCmd_CMD_802_11_BG_SCAN_QUERY); 2107 if (is_bgscan_resp) 2108 scan_rsp = &resp->params.bg_scan_query_resp.scan_resp; 2109 else 2110 scan_rsp = &resp->params.scan_resp; 2111 2112 2113 if (scan_rsp->number_of_sets > MWIFIEX_MAX_AP) { 2114 mwifiex_dbg(adapter, ERROR, 2115 "SCAN_RESP: too many AP returned (%d)\n", 2116 scan_rsp->number_of_sets); 2117 ret = -1; 2118 goto check_next_scan; 2119 } 2120 2121 /* Check csa channel expiry before parsing scan response */ 2122 mwifiex_11h_get_csa_closed_channel(priv); 2123 2124 bytes_left = le16_to_cpu(scan_rsp->bss_descript_size); 2125 mwifiex_dbg(adapter, INFO, 2126 "info: SCAN_RESP: bss_descript_size %d\n", 2127 bytes_left); 2128 2129 scan_resp_size = le16_to_cpu(resp->size); 2130 2131 mwifiex_dbg(adapter, INFO, 2132 "info: SCAN_RESP: returned %d APs before parsing\n", 2133 scan_rsp->number_of_sets); 2134 2135 bss_info = scan_rsp->bss_desc_and_tlv_buffer; 2136 2137 /* 2138 * The size of the TLV buffer is equal to the entire command response 2139 * size (scan_resp_size) minus the fixed fields (sizeof()'s), the 2140 * BSS Descriptions (bss_descript_size as bytesLef) and the command 2141 * response header (S_DS_GEN) 2142 */ 2143 tlv_buf_size = scan_resp_size - (bytes_left 2144 + sizeof(scan_rsp->bss_descript_size) 2145 + sizeof(scan_rsp->number_of_sets) 2146 + S_DS_GEN); 2147 2148 tlv_data = (struct mwifiex_ie_types_data *) (scan_rsp-> 2149 bss_desc_and_tlv_buffer + 2150 bytes_left); 2151 2152 /* Search the TLV buffer space in the scan response for any valid 2153 TLVs */ 2154 mwifiex_ret_802_11_scan_get_tlv_ptrs(adapter, tlv_data, tlv_buf_size, 2155 TLV_TYPE_TSFTIMESTAMP, 2156 (struct mwifiex_ie_types_data **) 2157 &tsf_tlv); 2158 2159 /* Search the TLV buffer space in the scan response for any valid 2160 TLVs */ 2161 mwifiex_ret_802_11_scan_get_tlv_ptrs(adapter, tlv_data, tlv_buf_size, 2162 TLV_TYPE_CHANNELBANDLIST, 2163 (struct mwifiex_ie_types_data **) 2164 &chan_band_tlv); 2165 2166 #ifdef CONFIG_PM 2167 if (priv->wdev.wiphy->wowlan_config) 2168 nd_config = priv->wdev.wiphy->wowlan_config->nd_config; 2169 #endif 2170 2171 if (nd_config) { 2172 adapter->nd_info = 2173 kzalloc(struct_size(adapter->nd_info, matches, 2174 scan_rsp->number_of_sets), 2175 GFP_ATOMIC); 2176 2177 if (adapter->nd_info) 2178 adapter->nd_info->n_matches = scan_rsp->number_of_sets; 2179 } 2180 2181 for (idx = 0; idx < scan_rsp->number_of_sets && bytes_left; idx++) { 2182 /* 2183 * If the TSF TLV was appended to the scan results, save this 2184 * entry's TSF value in the fw_tsf field. It is the firmware's 2185 * TSF value at the time the beacon or probe response was 2186 * received. 2187 */ 2188 if (tsf_tlv) 2189 memcpy(&fw_tsf, &tsf_tlv->tsf_data[idx * TSF_DATA_SIZE], 2190 sizeof(fw_tsf)); 2191 2192 if (chan_band_tlv) { 2193 chan_band = &chan_band_tlv->chan_band_param[idx]; 2194 radio_type = &chan_band->radio_type; 2195 } else { 2196 radio_type = NULL; 2197 } 2198 2199 if (chan_band_tlv && adapter->nd_info) { 2200 adapter->nd_info->matches[idx] = 2201 kzalloc(sizeof(*pmatch) + sizeof(u32), 2202 GFP_ATOMIC); 2203 2204 pmatch = adapter->nd_info->matches[idx]; 2205 2206 if (pmatch) { 2207 pmatch->n_channels = 1; 2208 pmatch->channels[0] = chan_band->chan_number; 2209 } 2210 } 2211 2212 ret = mwifiex_parse_single_response_buf(priv, &bss_info, 2213 &bytes_left, 2214 le64_to_cpu(fw_tsf), 2215 radio_type, false, 0); 2216 if (ret) 2217 goto check_next_scan; 2218 } 2219 2220 check_next_scan: 2221 mwifiex_check_next_scan_command(priv); 2222 return ret; 2223 } 2224 2225 /* 2226 * This function prepares an extended scan command to be sent to the firmware 2227 * 2228 * This uses the scan command configuration sent to the command processing 2229 * module in command preparation stage to configure a extended scan command 2230 * structure to send to firmware. 2231 */ 2232 int mwifiex_cmd_802_11_scan_ext(struct mwifiex_private *priv, 2233 struct host_cmd_ds_command *cmd, 2234 void *data_buf) 2235 { 2236 struct host_cmd_ds_802_11_scan_ext *ext_scan = &cmd->params.ext_scan; 2237 struct mwifiex_scan_cmd_config *scan_cfg = data_buf; 2238 2239 memcpy(ext_scan->tlv_buffer, scan_cfg->tlv_buf, scan_cfg->tlv_buf_len); 2240 2241 cmd->command = cpu_to_le16(HostCmd_CMD_802_11_SCAN_EXT); 2242 2243 /* Size is equal to the sizeof(fixed portions) + the TLV len + header */ 2244 cmd->size = cpu_to_le16((u16)(sizeof(ext_scan->reserved) 2245 + scan_cfg->tlv_buf_len + S_DS_GEN)); 2246 2247 return 0; 2248 } 2249 2250 /* This function prepares an background scan config command to be sent 2251 * to the firmware 2252 */ 2253 int mwifiex_cmd_802_11_bg_scan_config(struct mwifiex_private *priv, 2254 struct host_cmd_ds_command *cmd, 2255 void *data_buf) 2256 { 2257 struct host_cmd_ds_802_11_bg_scan_config *bgscan_config = 2258 &cmd->params.bg_scan_config; 2259 struct mwifiex_bg_scan_cfg *bgscan_cfg_in = data_buf; 2260 u8 *tlv_pos = bgscan_config->tlv; 2261 u8 num_probes; 2262 u32 ssid_len, chan_idx, scan_type, scan_dur, chan_num; 2263 int i; 2264 struct mwifiex_ie_types_num_probes *num_probes_tlv; 2265 struct mwifiex_ie_types_repeat_count *repeat_count_tlv; 2266 struct mwifiex_ie_types_min_rssi_threshold *rssi_threshold_tlv; 2267 struct mwifiex_ie_types_bgscan_start_later *start_later_tlv; 2268 struct mwifiex_ie_types_wildcard_ssid_params *wildcard_ssid_tlv; 2269 struct mwifiex_ie_types_chan_list_param_set *chan_list_tlv; 2270 struct mwifiex_chan_scan_param_set *temp_chan; 2271 2272 cmd->command = cpu_to_le16(HostCmd_CMD_802_11_BG_SCAN_CONFIG); 2273 cmd->size = cpu_to_le16(sizeof(*bgscan_config) + S_DS_GEN); 2274 2275 bgscan_config->action = cpu_to_le16(bgscan_cfg_in->action); 2276 bgscan_config->enable = bgscan_cfg_in->enable; 2277 bgscan_config->bss_type = bgscan_cfg_in->bss_type; 2278 bgscan_config->scan_interval = 2279 cpu_to_le32(bgscan_cfg_in->scan_interval); 2280 bgscan_config->report_condition = 2281 cpu_to_le32(bgscan_cfg_in->report_condition); 2282 2283 /* stop sched scan */ 2284 if (!bgscan_config->enable) 2285 return 0; 2286 2287 bgscan_config->chan_per_scan = bgscan_cfg_in->chan_per_scan; 2288 2289 num_probes = (bgscan_cfg_in->num_probes ? bgscan_cfg_in-> 2290 num_probes : priv->adapter->scan_probes); 2291 2292 if (num_probes) { 2293 num_probes_tlv = (struct mwifiex_ie_types_num_probes *)tlv_pos; 2294 num_probes_tlv->header.type = cpu_to_le16(TLV_TYPE_NUMPROBES); 2295 num_probes_tlv->header.len = 2296 cpu_to_le16(sizeof(num_probes_tlv->num_probes)); 2297 num_probes_tlv->num_probes = cpu_to_le16((u16)num_probes); 2298 2299 tlv_pos += sizeof(num_probes_tlv->header) + 2300 le16_to_cpu(num_probes_tlv->header.len); 2301 } 2302 2303 if (bgscan_cfg_in->repeat_count) { 2304 repeat_count_tlv = 2305 (struct mwifiex_ie_types_repeat_count *)tlv_pos; 2306 repeat_count_tlv->header.type = 2307 cpu_to_le16(TLV_TYPE_REPEAT_COUNT); 2308 repeat_count_tlv->header.len = 2309 cpu_to_le16(sizeof(repeat_count_tlv->repeat_count)); 2310 repeat_count_tlv->repeat_count = 2311 cpu_to_le16(bgscan_cfg_in->repeat_count); 2312 2313 tlv_pos += sizeof(repeat_count_tlv->header) + 2314 le16_to_cpu(repeat_count_tlv->header.len); 2315 } 2316 2317 if (bgscan_cfg_in->rssi_threshold) { 2318 rssi_threshold_tlv = 2319 (struct mwifiex_ie_types_min_rssi_threshold *)tlv_pos; 2320 rssi_threshold_tlv->header.type = 2321 cpu_to_le16(TLV_TYPE_RSSI_LOW); 2322 rssi_threshold_tlv->header.len = 2323 cpu_to_le16(sizeof(rssi_threshold_tlv->rssi_threshold)); 2324 rssi_threshold_tlv->rssi_threshold = 2325 cpu_to_le16(bgscan_cfg_in->rssi_threshold); 2326 2327 tlv_pos += sizeof(rssi_threshold_tlv->header) + 2328 le16_to_cpu(rssi_threshold_tlv->header.len); 2329 } 2330 2331 for (i = 0; i < bgscan_cfg_in->num_ssids; i++) { 2332 ssid_len = bgscan_cfg_in->ssid_list[i].ssid.ssid_len; 2333 2334 wildcard_ssid_tlv = 2335 (struct mwifiex_ie_types_wildcard_ssid_params *)tlv_pos; 2336 wildcard_ssid_tlv->header.type = 2337 cpu_to_le16(TLV_TYPE_WILDCARDSSID); 2338 wildcard_ssid_tlv->header.len = cpu_to_le16( 2339 (u16)(ssid_len + sizeof(wildcard_ssid_tlv-> 2340 max_ssid_length))); 2341 2342 /* max_ssid_length = 0 tells firmware to perform 2343 * specific scan for the SSID filled, whereas 2344 * max_ssid_length = IEEE80211_MAX_SSID_LEN is for 2345 * wildcard scan. 2346 */ 2347 if (ssid_len) 2348 wildcard_ssid_tlv->max_ssid_length = 0; 2349 else 2350 wildcard_ssid_tlv->max_ssid_length = 2351 IEEE80211_MAX_SSID_LEN; 2352 2353 memcpy(wildcard_ssid_tlv->ssid, 2354 bgscan_cfg_in->ssid_list[i].ssid.ssid, ssid_len); 2355 2356 tlv_pos += (sizeof(wildcard_ssid_tlv->header) 2357 + le16_to_cpu(wildcard_ssid_tlv->header.len)); 2358 } 2359 2360 chan_list_tlv = (struct mwifiex_ie_types_chan_list_param_set *)tlv_pos; 2361 2362 if (bgscan_cfg_in->chan_list[0].chan_number) { 2363 dev_dbg(priv->adapter->dev, "info: bgscan: Using supplied channel list\n"); 2364 2365 chan_list_tlv->header.type = cpu_to_le16(TLV_TYPE_CHANLIST); 2366 2367 for (chan_idx = 0; 2368 chan_idx < MWIFIEX_BG_SCAN_CHAN_MAX && 2369 bgscan_cfg_in->chan_list[chan_idx].chan_number; 2370 chan_idx++) { 2371 temp_chan = &chan_list_tlv->chan_scan_param[chan_idx]; 2372 2373 /* Increment the TLV header length by size appended */ 2374 le16_unaligned_add_cpu(&chan_list_tlv->header.len, 2375 sizeof(*chan_list_tlv->chan_scan_param)); 2376 2377 temp_chan->chan_number = 2378 bgscan_cfg_in->chan_list[chan_idx].chan_number; 2379 temp_chan->radio_type = 2380 bgscan_cfg_in->chan_list[chan_idx].radio_type; 2381 2382 scan_type = 2383 bgscan_cfg_in->chan_list[chan_idx].scan_type; 2384 2385 if (scan_type == MWIFIEX_SCAN_TYPE_PASSIVE) 2386 temp_chan->chan_scan_mode_bitmap 2387 |= MWIFIEX_PASSIVE_SCAN; 2388 else 2389 temp_chan->chan_scan_mode_bitmap 2390 &= ~MWIFIEX_PASSIVE_SCAN; 2391 2392 if (bgscan_cfg_in->chan_list[chan_idx].scan_time) { 2393 scan_dur = (u16)bgscan_cfg_in-> 2394 chan_list[chan_idx].scan_time; 2395 } else { 2396 scan_dur = (scan_type == 2397 MWIFIEX_SCAN_TYPE_PASSIVE) ? 2398 priv->adapter->passive_scan_time : 2399 priv->adapter->specific_scan_time; 2400 } 2401 2402 temp_chan->min_scan_time = cpu_to_le16(scan_dur); 2403 temp_chan->max_scan_time = cpu_to_le16(scan_dur); 2404 } 2405 } else { 2406 dev_dbg(priv->adapter->dev, 2407 "info: bgscan: Creating full region channel list\n"); 2408 chan_num = 2409 mwifiex_bgscan_create_channel_list(priv, bgscan_cfg_in, 2410 chan_list_tlv-> 2411 chan_scan_param); 2412 le16_unaligned_add_cpu(&chan_list_tlv->header.len, 2413 chan_num * 2414 sizeof(*chan_list_tlv->chan_scan_param)); 2415 } 2416 2417 tlv_pos += (sizeof(chan_list_tlv->header) 2418 + le16_to_cpu(chan_list_tlv->header.len)); 2419 2420 if (bgscan_cfg_in->start_later) { 2421 start_later_tlv = 2422 (struct mwifiex_ie_types_bgscan_start_later *)tlv_pos; 2423 start_later_tlv->header.type = 2424 cpu_to_le16(TLV_TYPE_BGSCAN_START_LATER); 2425 start_later_tlv->header.len = 2426 cpu_to_le16(sizeof(start_later_tlv->start_later)); 2427 start_later_tlv->start_later = 2428 cpu_to_le16(bgscan_cfg_in->start_later); 2429 2430 tlv_pos += sizeof(start_later_tlv->header) + 2431 le16_to_cpu(start_later_tlv->header.len); 2432 } 2433 2434 /* Append vendor specific IE TLV */ 2435 mwifiex_cmd_append_vsie_tlv(priv, MWIFIEX_VSIE_MASK_BGSCAN, &tlv_pos); 2436 2437 le16_unaligned_add_cpu(&cmd->size, tlv_pos - bgscan_config->tlv); 2438 2439 return 0; 2440 } 2441 2442 int mwifiex_stop_bg_scan(struct mwifiex_private *priv) 2443 { 2444 struct mwifiex_bg_scan_cfg *bgscan_cfg; 2445 2446 if (!priv->sched_scanning) { 2447 dev_dbg(priv->adapter->dev, "bgscan already stopped!\n"); 2448 return 0; 2449 } 2450 2451 bgscan_cfg = kzalloc(sizeof(*bgscan_cfg), GFP_KERNEL); 2452 if (!bgscan_cfg) 2453 return -ENOMEM; 2454 2455 bgscan_cfg->bss_type = MWIFIEX_BSS_MODE_INFRA; 2456 bgscan_cfg->action = MWIFIEX_BGSCAN_ACT_SET; 2457 bgscan_cfg->enable = false; 2458 2459 if (mwifiex_send_cmd(priv, HostCmd_CMD_802_11_BG_SCAN_CONFIG, 2460 HostCmd_ACT_GEN_SET, 0, bgscan_cfg, true)) { 2461 kfree(bgscan_cfg); 2462 return -EFAULT; 2463 } 2464 2465 kfree(bgscan_cfg); 2466 priv->sched_scanning = false; 2467 2468 return 0; 2469 } 2470 2471 static void 2472 mwifiex_update_chan_statistics(struct mwifiex_private *priv, 2473 struct mwifiex_ietypes_chanstats *tlv_stat) 2474 { 2475 struct mwifiex_adapter *adapter = priv->adapter; 2476 u8 i, num_chan; 2477 struct mwifiex_fw_chan_stats *fw_chan_stats; 2478 struct mwifiex_chan_stats chan_stats; 2479 2480 fw_chan_stats = (void *)((u8 *)tlv_stat + 2481 sizeof(struct mwifiex_ie_types_header)); 2482 num_chan = le16_to_cpu(tlv_stat->header.len) / 2483 sizeof(struct mwifiex_chan_stats); 2484 2485 for (i = 0 ; i < num_chan; i++) { 2486 if (adapter->survey_idx >= adapter->num_in_chan_stats) { 2487 mwifiex_dbg(adapter, WARN, 2488 "FW reported too many channel results (max %d)\n", 2489 adapter->num_in_chan_stats); 2490 return; 2491 } 2492 chan_stats.chan_num = fw_chan_stats->chan_num; 2493 chan_stats.bandcfg = fw_chan_stats->bandcfg; 2494 chan_stats.flags = fw_chan_stats->flags; 2495 chan_stats.noise = fw_chan_stats->noise; 2496 chan_stats.total_bss = le16_to_cpu(fw_chan_stats->total_bss); 2497 chan_stats.cca_scan_dur = 2498 le16_to_cpu(fw_chan_stats->cca_scan_dur); 2499 chan_stats.cca_busy_dur = 2500 le16_to_cpu(fw_chan_stats->cca_busy_dur); 2501 mwifiex_dbg(adapter, INFO, 2502 "chan=%d, noise=%d, total_network=%d scan_duration=%d, busy_duration=%d\n", 2503 chan_stats.chan_num, 2504 chan_stats.noise, 2505 chan_stats.total_bss, 2506 chan_stats.cca_scan_dur, 2507 chan_stats.cca_busy_dur); 2508 memcpy(&adapter->chan_stats[adapter->survey_idx++], &chan_stats, 2509 sizeof(struct mwifiex_chan_stats)); 2510 fw_chan_stats++; 2511 } 2512 } 2513 2514 /* This function handles the command response of extended scan */ 2515 int mwifiex_ret_802_11_scan_ext(struct mwifiex_private *priv, 2516 struct host_cmd_ds_command *resp) 2517 { 2518 struct mwifiex_adapter *adapter = priv->adapter; 2519 struct host_cmd_ds_802_11_scan_ext *ext_scan_resp; 2520 struct mwifiex_ie_types_header *tlv; 2521 struct mwifiex_ietypes_chanstats *tlv_stat; 2522 u16 buf_left, type, len; 2523 2524 struct host_cmd_ds_command *cmd_ptr; 2525 struct cmd_ctrl_node *cmd_node; 2526 bool complete_scan = false; 2527 2528 mwifiex_dbg(adapter, INFO, "info: EXT scan returns successfully\n"); 2529 2530 ext_scan_resp = &resp->params.ext_scan; 2531 2532 tlv = (void *)ext_scan_resp->tlv_buffer; 2533 buf_left = le16_to_cpu(resp->size) - (sizeof(*ext_scan_resp) + S_DS_GEN 2534 - 1); 2535 2536 while (buf_left >= sizeof(struct mwifiex_ie_types_header)) { 2537 type = le16_to_cpu(tlv->type); 2538 len = le16_to_cpu(tlv->len); 2539 2540 if (buf_left < (sizeof(struct mwifiex_ie_types_header) + len)) { 2541 mwifiex_dbg(adapter, ERROR, 2542 "error processing scan response TLVs"); 2543 break; 2544 } 2545 2546 switch (type) { 2547 case TLV_TYPE_CHANNEL_STATS: 2548 tlv_stat = (void *)tlv; 2549 mwifiex_update_chan_statistics(priv, tlv_stat); 2550 break; 2551 default: 2552 break; 2553 } 2554 2555 buf_left -= len + sizeof(struct mwifiex_ie_types_header); 2556 tlv = (void *)((u8 *)tlv + len + 2557 sizeof(struct mwifiex_ie_types_header)); 2558 } 2559 2560 spin_lock_bh(&adapter->cmd_pending_q_lock); 2561 spin_lock_bh(&adapter->scan_pending_q_lock); 2562 if (list_empty(&adapter->scan_pending_q)) { 2563 complete_scan = true; 2564 list_for_each_entry(cmd_node, &adapter->cmd_pending_q, list) { 2565 cmd_ptr = (void *)cmd_node->cmd_skb->data; 2566 if (le16_to_cpu(cmd_ptr->command) == 2567 HostCmd_CMD_802_11_SCAN_EXT) { 2568 mwifiex_dbg(adapter, INFO, 2569 "Scan pending in command pending list"); 2570 complete_scan = false; 2571 break; 2572 } 2573 } 2574 } 2575 spin_unlock_bh(&adapter->scan_pending_q_lock); 2576 spin_unlock_bh(&adapter->cmd_pending_q_lock); 2577 2578 if (complete_scan) 2579 mwifiex_complete_scan(priv); 2580 2581 return 0; 2582 } 2583 2584 /* This function This function handles the event extended scan report. It 2585 * parses extended scan results and informs to cfg80211 stack. 2586 */ 2587 int mwifiex_handle_event_ext_scan_report(struct mwifiex_private *priv, 2588 void *buf) 2589 { 2590 int ret = 0; 2591 struct mwifiex_adapter *adapter = priv->adapter; 2592 u8 *bss_info; 2593 u32 bytes_left, bytes_left_for_tlv, idx; 2594 u16 type, len; 2595 struct mwifiex_ie_types_data *tlv; 2596 struct mwifiex_ie_types_bss_scan_rsp *scan_rsp_tlv; 2597 struct mwifiex_ie_types_bss_scan_info *scan_info_tlv; 2598 u8 *radio_type; 2599 u64 fw_tsf = 0; 2600 s32 rssi = 0; 2601 struct mwifiex_event_scan_result *event_scan = buf; 2602 u8 num_of_set = event_scan->num_of_set; 2603 u8 *scan_resp = buf + sizeof(struct mwifiex_event_scan_result); 2604 u16 scan_resp_size = le16_to_cpu(event_scan->buf_size); 2605 2606 if (num_of_set > MWIFIEX_MAX_AP) { 2607 mwifiex_dbg(adapter, ERROR, 2608 "EXT_SCAN: Invalid number of AP returned (%d)!!\n", 2609 num_of_set); 2610 ret = -1; 2611 goto check_next_scan; 2612 } 2613 2614 bytes_left = scan_resp_size; 2615 mwifiex_dbg(adapter, INFO, 2616 "EXT_SCAN: size %d, returned %d APs...", 2617 scan_resp_size, num_of_set); 2618 mwifiex_dbg_dump(adapter, CMD_D, "EXT_SCAN buffer:", buf, 2619 scan_resp_size + 2620 sizeof(struct mwifiex_event_scan_result)); 2621 2622 tlv = (struct mwifiex_ie_types_data *)scan_resp; 2623 2624 for (idx = 0; idx < num_of_set && bytes_left; idx++) { 2625 type = le16_to_cpu(tlv->header.type); 2626 len = le16_to_cpu(tlv->header.len); 2627 if (bytes_left < sizeof(struct mwifiex_ie_types_header) + len) { 2628 mwifiex_dbg(adapter, ERROR, 2629 "EXT_SCAN: Error bytes left < TLV length\n"); 2630 break; 2631 } 2632 scan_rsp_tlv = NULL; 2633 scan_info_tlv = NULL; 2634 bytes_left_for_tlv = bytes_left; 2635 2636 /* BSS response TLV with beacon or probe response buffer 2637 * at the initial position of each descriptor 2638 */ 2639 if (type != TLV_TYPE_BSS_SCAN_RSP) 2640 break; 2641 2642 bss_info = (u8 *)tlv; 2643 scan_rsp_tlv = (struct mwifiex_ie_types_bss_scan_rsp *)tlv; 2644 tlv = (struct mwifiex_ie_types_data *)(tlv->data + len); 2645 bytes_left_for_tlv -= 2646 (len + sizeof(struct mwifiex_ie_types_header)); 2647 2648 while (bytes_left_for_tlv >= 2649 sizeof(struct mwifiex_ie_types_header) && 2650 le16_to_cpu(tlv->header.type) != TLV_TYPE_BSS_SCAN_RSP) { 2651 type = le16_to_cpu(tlv->header.type); 2652 len = le16_to_cpu(tlv->header.len); 2653 if (bytes_left_for_tlv < 2654 sizeof(struct mwifiex_ie_types_header) + len) { 2655 mwifiex_dbg(adapter, ERROR, 2656 "EXT_SCAN: Error in processing TLV,\t" 2657 "bytes left < TLV length\n"); 2658 scan_rsp_tlv = NULL; 2659 bytes_left_for_tlv = 0; 2660 continue; 2661 } 2662 switch (type) { 2663 case TLV_TYPE_BSS_SCAN_INFO: 2664 scan_info_tlv = 2665 (struct mwifiex_ie_types_bss_scan_info *)tlv; 2666 if (len != 2667 sizeof(struct mwifiex_ie_types_bss_scan_info) - 2668 sizeof(struct mwifiex_ie_types_header)) { 2669 bytes_left_for_tlv = 0; 2670 continue; 2671 } 2672 break; 2673 default: 2674 break; 2675 } 2676 tlv = (struct mwifiex_ie_types_data *)(tlv->data + len); 2677 bytes_left -= 2678 (len + sizeof(struct mwifiex_ie_types_header)); 2679 bytes_left_for_tlv -= 2680 (len + sizeof(struct mwifiex_ie_types_header)); 2681 } 2682 2683 if (!scan_rsp_tlv) 2684 break; 2685 2686 /* Advance pointer to the beacon buffer length and 2687 * update the bytes count so that the function 2688 * wlan_interpret_bss_desc_with_ie() can handle the 2689 * scan buffer withut any change 2690 */ 2691 bss_info += sizeof(u16); 2692 bytes_left -= sizeof(u16); 2693 2694 if (scan_info_tlv) { 2695 rssi = (s32)(s16)(le16_to_cpu(scan_info_tlv->rssi)); 2696 rssi *= 100; /* Convert dBm to mBm */ 2697 mwifiex_dbg(adapter, INFO, 2698 "info: InterpretIE: RSSI=%d\n", rssi); 2699 fw_tsf = le64_to_cpu(scan_info_tlv->tsf); 2700 radio_type = &scan_info_tlv->radio_type; 2701 } else { 2702 radio_type = NULL; 2703 } 2704 ret = mwifiex_parse_single_response_buf(priv, &bss_info, 2705 &bytes_left, fw_tsf, 2706 radio_type, true, rssi); 2707 if (ret) 2708 goto check_next_scan; 2709 } 2710 2711 check_next_scan: 2712 if (!event_scan->more_event) 2713 mwifiex_check_next_scan_command(priv); 2714 2715 return ret; 2716 } 2717 2718 /* 2719 * This function prepares command for background scan query. 2720 * 2721 * Preparation includes - 2722 * - Setting command ID and proper size 2723 * - Setting background scan flush parameter 2724 * - Ensuring correct endian-ness 2725 */ 2726 int mwifiex_cmd_802_11_bg_scan_query(struct host_cmd_ds_command *cmd) 2727 { 2728 struct host_cmd_ds_802_11_bg_scan_query *bg_query = 2729 &cmd->params.bg_scan_query; 2730 2731 cmd->command = cpu_to_le16(HostCmd_CMD_802_11_BG_SCAN_QUERY); 2732 cmd->size = cpu_to_le16(sizeof(struct host_cmd_ds_802_11_bg_scan_query) 2733 + S_DS_GEN); 2734 2735 bg_query->flush = 1; 2736 2737 return 0; 2738 } 2739 2740 /* 2741 * This function inserts scan command node to the scan pending queue. 2742 */ 2743 void 2744 mwifiex_queue_scan_cmd(struct mwifiex_private *priv, 2745 struct cmd_ctrl_node *cmd_node) 2746 { 2747 struct mwifiex_adapter *adapter = priv->adapter; 2748 2749 cmd_node->wait_q_enabled = true; 2750 cmd_node->condition = &adapter->scan_wait_q_woken; 2751 spin_lock_bh(&adapter->scan_pending_q_lock); 2752 list_add_tail(&cmd_node->list, &adapter->scan_pending_q); 2753 spin_unlock_bh(&adapter->scan_pending_q_lock); 2754 } 2755 2756 /* 2757 * This function sends a scan command for all available channels to the 2758 * firmware, filtered on a specific SSID. 2759 */ 2760 static int mwifiex_scan_specific_ssid(struct mwifiex_private *priv, 2761 struct cfg80211_ssid *req_ssid) 2762 { 2763 struct mwifiex_adapter *adapter = priv->adapter; 2764 int ret; 2765 struct mwifiex_user_scan_cfg *scan_cfg; 2766 2767 if (adapter->scan_processing) { 2768 mwifiex_dbg(adapter, WARN, 2769 "cmd: Scan already in process...\n"); 2770 return -EBUSY; 2771 } 2772 2773 if (priv->scan_block) { 2774 mwifiex_dbg(adapter, WARN, 2775 "cmd: Scan is blocked during association...\n"); 2776 return -EBUSY; 2777 } 2778 2779 scan_cfg = kzalloc(sizeof(struct mwifiex_user_scan_cfg), GFP_KERNEL); 2780 if (!scan_cfg) 2781 return -ENOMEM; 2782 2783 scan_cfg->ssid_list = req_ssid; 2784 scan_cfg->num_ssids = 1; 2785 2786 ret = mwifiex_scan_networks(priv, scan_cfg); 2787 2788 kfree(scan_cfg); 2789 return ret; 2790 } 2791 2792 /* 2793 * Sends IOCTL request to start a scan. 2794 * 2795 * This function allocates the IOCTL request buffer, fills it 2796 * with requisite parameters and calls the IOCTL handler. 2797 * 2798 * Scan command can be issued for both normal scan and specific SSID 2799 * scan, depending upon whether an SSID is provided or not. 2800 */ 2801 int mwifiex_request_scan(struct mwifiex_private *priv, 2802 struct cfg80211_ssid *req_ssid) 2803 { 2804 int ret; 2805 2806 if (mutex_lock_interruptible(&priv->async_mutex)) { 2807 mwifiex_dbg(priv->adapter, ERROR, 2808 "%s: acquire semaphore fail\n", 2809 __func__); 2810 return -1; 2811 } 2812 2813 priv->adapter->scan_wait_q_woken = false; 2814 2815 if (req_ssid && req_ssid->ssid_len != 0) 2816 /* Specific SSID scan */ 2817 ret = mwifiex_scan_specific_ssid(priv, req_ssid); 2818 else 2819 /* Normal scan */ 2820 ret = mwifiex_scan_networks(priv, NULL); 2821 2822 mutex_unlock(&priv->async_mutex); 2823 2824 return ret; 2825 } 2826 2827 /* 2828 * This function appends the vendor specific IE TLV to a buffer. 2829 */ 2830 int 2831 mwifiex_cmd_append_vsie_tlv(struct mwifiex_private *priv, 2832 u16 vsie_mask, u8 **buffer) 2833 { 2834 int id, ret_len = 0; 2835 struct mwifiex_ie_types_vendor_param_set *vs_param_set; 2836 2837 if (!buffer) 2838 return 0; 2839 if (!(*buffer)) 2840 return 0; 2841 2842 /* 2843 * Traverse through the saved vendor specific IE array and append 2844 * the selected(scan/assoc/adhoc) IE as TLV to the command 2845 */ 2846 for (id = 0; id < MWIFIEX_MAX_VSIE_NUM; id++) { 2847 if (priv->vs_ie[id].mask & vsie_mask) { 2848 vs_param_set = 2849 (struct mwifiex_ie_types_vendor_param_set *) 2850 *buffer; 2851 vs_param_set->header.type = 2852 cpu_to_le16(TLV_TYPE_PASSTHROUGH); 2853 vs_param_set->header.len = 2854 cpu_to_le16((((u16) priv->vs_ie[id].ie[1]) 2855 & 0x00FF) + 2); 2856 if (le16_to_cpu(vs_param_set->header.len) > 2857 MWIFIEX_MAX_VSIE_LEN) { 2858 mwifiex_dbg(priv->adapter, ERROR, 2859 "Invalid param length!\n"); 2860 break; 2861 } 2862 2863 memcpy(vs_param_set->ie, priv->vs_ie[id].ie, 2864 le16_to_cpu(vs_param_set->header.len)); 2865 *buffer += le16_to_cpu(vs_param_set->header.len) + 2866 sizeof(struct mwifiex_ie_types_header); 2867 ret_len += le16_to_cpu(vs_param_set->header.len) + 2868 sizeof(struct mwifiex_ie_types_header); 2869 } 2870 } 2871 return ret_len; 2872 } 2873 2874 /* 2875 * This function saves a beacon buffer of the current BSS descriptor. 2876 * 2877 * The current beacon buffer is saved so that it can be restored in the 2878 * following cases that makes the beacon buffer not to contain the current 2879 * ssid's beacon buffer. 2880 * - The current ssid was not found somehow in the last scan. 2881 * - The current ssid was the last entry of the scan table and overloaded. 2882 */ 2883 void 2884 mwifiex_save_curr_bcn(struct mwifiex_private *priv) 2885 { 2886 struct mwifiex_bssdescriptor *curr_bss = 2887 &priv->curr_bss_params.bss_descriptor; 2888 2889 if (!curr_bss->beacon_buf_size) 2890 return; 2891 2892 /* allocate beacon buffer at 1st time; or if it's size has changed */ 2893 if (!priv->curr_bcn_buf || 2894 priv->curr_bcn_size != curr_bss->beacon_buf_size) { 2895 priv->curr_bcn_size = curr_bss->beacon_buf_size; 2896 2897 kfree(priv->curr_bcn_buf); 2898 priv->curr_bcn_buf = kmalloc(curr_bss->beacon_buf_size, 2899 GFP_ATOMIC); 2900 if (!priv->curr_bcn_buf) 2901 return; 2902 } 2903 2904 memcpy(priv->curr_bcn_buf, curr_bss->beacon_buf, 2905 curr_bss->beacon_buf_size); 2906 mwifiex_dbg(priv->adapter, INFO, 2907 "info: current beacon saved %d\n", 2908 priv->curr_bcn_size); 2909 2910 curr_bss->beacon_buf = priv->curr_bcn_buf; 2911 2912 /* adjust the pointers in the current BSS descriptor */ 2913 if (curr_bss->bcn_wpa_ie) 2914 curr_bss->bcn_wpa_ie = 2915 (struct ieee_types_vendor_specific *) 2916 (curr_bss->beacon_buf + 2917 curr_bss->wpa_offset); 2918 2919 if (curr_bss->bcn_rsn_ie) 2920 curr_bss->bcn_rsn_ie = (struct ieee_types_generic *) 2921 (curr_bss->beacon_buf + 2922 curr_bss->rsn_offset); 2923 2924 if (curr_bss->bcn_ht_cap) 2925 curr_bss->bcn_ht_cap = (struct ieee80211_ht_cap *) 2926 (curr_bss->beacon_buf + 2927 curr_bss->ht_cap_offset); 2928 2929 if (curr_bss->bcn_ht_oper) 2930 curr_bss->bcn_ht_oper = (struct ieee80211_ht_operation *) 2931 (curr_bss->beacon_buf + 2932 curr_bss->ht_info_offset); 2933 2934 if (curr_bss->bcn_vht_cap) 2935 curr_bss->bcn_vht_cap = (void *)(curr_bss->beacon_buf + 2936 curr_bss->vht_cap_offset); 2937 2938 if (curr_bss->bcn_vht_oper) 2939 curr_bss->bcn_vht_oper = (void *)(curr_bss->beacon_buf + 2940 curr_bss->vht_info_offset); 2941 2942 if (curr_bss->bcn_bss_co_2040) 2943 curr_bss->bcn_bss_co_2040 = 2944 (curr_bss->beacon_buf + curr_bss->bss_co_2040_offset); 2945 2946 if (curr_bss->bcn_ext_cap) 2947 curr_bss->bcn_ext_cap = curr_bss->beacon_buf + 2948 curr_bss->ext_cap_offset; 2949 2950 if (curr_bss->oper_mode) 2951 curr_bss->oper_mode = (void *)(curr_bss->beacon_buf + 2952 curr_bss->oper_mode_offset); 2953 } 2954 2955 /* 2956 * This function frees the current BSS descriptor beacon buffer. 2957 */ 2958 void 2959 mwifiex_free_curr_bcn(struct mwifiex_private *priv) 2960 { 2961 kfree(priv->curr_bcn_buf); 2962 priv->curr_bcn_buf = NULL; 2963 } 2964