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