blob: 34742d1f766ef7507625de719c068848a99e2cdc [file] [log] [blame]
Om Prakash Tripathi7e3f45d2016-12-28 16:58:54 +05301/*
2 * Copyright (c) 2017 The Linux Foundation. All rights reserved.
3 *
4 * Permission to use, copy, modify, and/or distribute this software for
5 * any purpose with or without fee is hereby granted, provided that the
6 * above copyright notice and this permission notice appear in all
7 * copies.
8 *
9 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
10 * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
11 * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
12 * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
13 * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
14 * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
15 * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
16 * PERFORMANCE OF THIS SOFTWARE.
17 */
18
19/*
20 * DOC: Defines scan utility functions
21 */
Om Prakash Tripathi22f95dc2016-12-19 10:45:59 +053022
Abhishek Singh4caf1a92017-02-21 15:01:08 +053023#include <wlan_cmn.h>
Om Prakash Tripathi22f95dc2016-12-19 10:45:59 +053024#include <wlan_scan_ucfg_api.h>
25#include <wlan_scan_utils_api.h>
26#include <../../core/src/wlan_scan_cache_db.h>
27#include <../../core/src/wlan_scan_main.h>
28
29const char*
30util_scan_get_ev_type_name(enum scan_event_type type)
31{
32 static const char * const event_name[] = {
33 [SCAN_EVENT_TYPE_STARTED] = "STARTED",
34 [SCAN_EVENT_TYPE_COMPLETED] = "COMPLETED",
35 [SCAN_EVENT_TYPE_BSS_CHANNEL] = "HOME_CHANNEL",
36 [SCAN_EVENT_TYPE_FOREIGN_CHANNEL] = "FOREIGN_CHANNEL",
37 [SCAN_EVENT_TYPE_DEQUEUED] = "DEQUEUED",
38 [SCAN_EVENT_TYPE_PREEMPTED] = "PREEMPTED",
39 [SCAN_EVENT_TYPE_START_FAILED] = "START_FAILED",
40 [SCAN_EVENT_TYPE_RESTARTED] = "RESTARTED",
41 [SCAN_EVENT_TYPE_FOREIGN_CHANNEL_EXIT] = "FOREIGN_CHANNEL_EXIT",
42 [SCAN_EVENT_TYPE_SUSPENDED] = "SUSPENDED",
43 [SCAN_EVENT_TYPE_RESUMED] = "RESUMED",
44 [SCAN_EVENT_TYPE_NLO_COMPLETE] = "NLO_COMPLETE",
Abhishek Singh8c6e82d2017-03-03 21:57:29 +053045 [SCAN_EVENT_TYPE_NLO_MATCH] = "NLO_MATCH",
Om Prakash Tripathi22f95dc2016-12-19 10:45:59 +053046 [SCAN_EVENT_TYPE_INVALID] = "INVALID",
47 [SCAN_EVENT_TYPE_GPIO_TIMEOUT] = "GPIO_TIMEOUT",
48 [SCAN_EVENT_TYPE_RADIO_MEASUREMENT_START] =
49 "RADIO_MEASUREMENT_START",
50 [SCAN_EVENT_TYPE_RADIO_MEASUREMENT_END] =
51 "RADIO_MEASUREMENT_END",
52 [SCAN_EVENT_TYPE_BSSID_MATCH] = "BSSID_MATCH",
53 [SCAN_EVENT_TYPE_FOREIGN_CHANNEL_GET_NF] =
54 "FOREIGN_CHANNEL_GET_NF",
55 };
56
Abhishek Singh483d9142017-03-06 13:28:13 +053057 if (type >= SCAN_EVENT_TYPE_MAX)
Om Prakash Tripathi22f95dc2016-12-19 10:45:59 +053058 return "UNKNOWN";
Om Prakash Tripathi22f95dc2016-12-19 10:45:59 +053059
60 return event_name[type];
61}
62
63
64const char*
65util_scan_get_ev_reason_name(enum scan_completion_reason reason)
66{
67 static const char * const reason_name[] = {
68 [SCAN_REASON_NONE] = "NONE",
69 [SCAN_REASON_COMPLETED] = "COMPLETED",
70 [SCAN_REASON_CANCELLED] = "CANCELLED",
71 [SCAN_REASON_PREEMPTED] = "PREEMPTED",
72 [SCAN_REASON_TIMEDOUT] = "TIMEDOUT",
73 [SCAN_REASON_INTERNAL_FAILURE] = "INTERNAL_FAILURE",
74 [SCAN_REASON_SUSPENDED] = "SUSPENDED",
75 [SCAN_REASON_RUN_FAILED] = "RUN_FAILED",
76 [SCAN_REASON_TERMINATION_FUNCTION] = "TERMINATION_FUNCTION",
77 [SCAN_REASON_MAX_OFFCHAN_RETRIES] = "MAX_OFFCHAN_RETRIES",
78 };
79
Abhishek Singh483d9142017-03-06 13:28:13 +053080 if (reason >= SCAN_REASON_MAX)
Om Prakash Tripathi22f95dc2016-12-19 10:45:59 +053081 return "UNKNOWN";
Om Prakash Tripathi22f95dc2016-12-19 10:45:59 +053082
83 return reason_name[reason];
84}
85
86qdf_time_t
87util_get_last_scan_time(struct wlan_objmgr_vdev *vdev)
88{
89 uint8_t pdev_id;
90 struct wlan_scan_obj *scan_obj;
91
92 if (!vdev) {
93 scm_warn("null vdev");
94 QDF_ASSERT(0);
95 return 0;
96 }
97 pdev_id = wlan_scan_vdev_get_pdev_id(vdev);
98 scan_obj = wlan_vdev_get_scan_obj(vdev);
99
100 return scan_obj->pdev_info[pdev_id].last_scan_time;
101}
Abhishek Singh4caf1a92017-02-21 15:01:08 +0530102
103static enum wlan_band scm_chan_to_band(uint32_t chan)
104{
105 if (WLAN_CHAN_IS_2GHZ(chan))
106 return WLAN_BAND_2_4_GHZ;
107
108 return WLAN_BAND_5_GHZ;
109}
110
Abhishek Singhd4e600f2017-02-21 15:16:28 +0530111bool util_is_scan_entry_match(
112 struct scan_cache_entry *entry1,
113 struct scan_cache_entry *entry2)
114{
115
116 if (entry1->cap_info.wlan_caps.ess !=
117 entry1->cap_info.wlan_caps.ess)
118 return false;
119
120 if (entry1->cap_info.wlan_caps.ess &&
121 !qdf_mem_cmp(entry1->bssid.bytes,
Om Prakash Tripathic3fcb682017-08-01 18:24:55 +0530122 entry2->bssid.bytes, QDF_MAC_ADDR_SIZE) &&
Abhishek Singhd4e600f2017-02-21 15:16:28 +0530123 scm_chan_to_band(
124 entry1->channel.chan_idx) ==
125 scm_chan_to_band(entry2->channel.chan_idx)) {
126 /* Check for BSS */
127 if (util_is_ssid_match(
128 &entry1->ssid, &entry2->ssid))
129 return true;
130 } else if (entry1->cap_info.wlan_caps.ibss &&
131 (entry1->channel.chan_idx ==
132 entry2->channel.chan_idx)) {
133 /*
134 * Same channel cannot have same SSID for
135 * different IBSS, so no need to check BSSID
136 */
137 if (util_is_ssid_match(
138 &entry1->ssid, &entry2->ssid))
139 return true;
140 } else if (!entry1->cap_info.wlan_caps.ibss &&
141 !entry1->cap_info.wlan_caps.ess &&
142 !qdf_mem_cmp(entry1->bssid.bytes,
Om Prakash Tripathic3fcb682017-08-01 18:24:55 +0530143 entry2->bssid.bytes, QDF_MAC_ADDR_SIZE)) {
Abhishek Singhd4e600f2017-02-21 15:16:28 +0530144 /* In case of P2P devices, ess and ibss will be set to zero */
145 return true;
146 }
147
148 return false;
149}
150
Abhishek Singh4caf1a92017-02-21 15:01:08 +0530151static bool util_is_pureg_rate(uint8_t *rates, uint8_t nrates)
152{
153 static const uint8_t g_rates[] = {12, 18, 24, 36, 48, 72, 96, 108};
154 bool pureg = false;
155 uint8_t i, j;
156
157 for (i = 0; i < nrates; i++) {
158 for (j = 0; j < QDF_ARRAY_SIZE(g_rates); j++) {
159 if (WLAN_RV(rates[i]) == g_rates[j]) {
160 pureg = true;
161 break;
162 }
163 }
164 if (pureg)
165 break;
166 }
167
168 return pureg;
169}
170static enum wlan_phymode
171util_scan_get_phymode_5g(struct scan_cache_entry *scan_params)
172{
173 enum wlan_phymode phymode = WLAN_PHYMODE_AUTO;
174 uint16_t ht_cap = 0;
175 struct htcap_cmn_ie *htcap;
176 struct wlan_ie_htinfo_cmn *htinfo;
177 struct wlan_ie_vhtop *vhtop;
178
179 htcap = (struct htcap_cmn_ie *)
180 util_scan_entry_htcap(scan_params);
181 htinfo = (struct wlan_ie_htinfo_cmn *)
182 util_scan_entry_htinfo(scan_params);
183 vhtop = (struct wlan_ie_vhtop *)
184 util_scan_entry_vhtop(scan_params);
185
186 if (!(htcap && htinfo))
187 return WLAN_PHYMODE_11A;
188
189 if (htcap)
190 ht_cap = le16toh(htcap->hc_cap);
191
192 if (util_scan_entry_vhtcap(scan_params) && vhtop) {
193 switch (vhtop->vht_op_chwidth) {
194 case WLAN_VHTOP_CHWIDTH_2040:
195 if ((ht_cap & WLAN_HTCAP_C_CHWIDTH40) &&
196 (htinfo->hi_extchoff ==
197 WLAN_HTINFO_EXTOFFSET_ABOVE))
198 phymode = WLAN_PHYMODE_11AC_VHT40PLUS;
199 else if ((ht_cap & WLAN_HTCAP_C_CHWIDTH40) &&
200 (htinfo->hi_extchoff ==
201 WLAN_HTINFO_EXTOFFSET_BELOW))
202 phymode = WLAN_PHYMODE_11AC_VHT40MINUS;
203 else
204 phymode = WLAN_PHYMODE_11AC_VHT20;
205 break;
206 case WLAN_VHTOP_CHWIDTH_80:
207 if (WLAN_IS_REVSIG_VHT80_80(vhtop))
208 phymode = WLAN_PHYMODE_11AC_VHT80_80;
209 else if (WLAN_IS_REVSIG_VHT160(vhtop))
210 phymode = WLAN_PHYMODE_11AC_VHT160;
211 else
212 phymode = WLAN_PHYMODE_11AC_VHT80;
213 break;
214 case WLAN_VHTOP_CHWIDTH_160:
215 phymode = WLAN_PHYMODE_11AC_VHT160;
216 break;
217 case WLAN_VHTOP_CHWIDTH_80_80:
218 phymode = WLAN_PHYMODE_11AC_VHT80_80;
219 break;
220 default:
221 scm_err("bad channel: %d",
222 vhtop->vht_op_chwidth);
223 break;
224 }
225 } else if ((ht_cap & WLAN_HTCAP_C_CHWIDTH40) &&
226 (htinfo->hi_extchoff == WLAN_HTINFO_EXTOFFSET_ABOVE))
227 phymode = WLAN_PHYMODE_11NA_HT40PLUS;
228 else if ((ht_cap & WLAN_HTCAP_C_CHWIDTH40) &&
229 (htinfo->hi_extchoff == WLAN_HTINFO_EXTOFFSET_BELOW))
230 phymode = WLAN_PHYMODE_11NA_HT40MINUS;
231 else
232 phymode = WLAN_PHYMODE_11NA_HT20;
233
234 return phymode;
235}
236
237static enum wlan_phymode
238util_scan_get_phymode_2g(struct scan_cache_entry *scan_params)
239{
240 enum wlan_phymode phymode = WLAN_PHYMODE_AUTO;
241 uint16_t ht_cap = 0;
242 struct htcap_cmn_ie *htcap;
243 struct wlan_ie_htinfo_cmn *htinfo;
244 struct wlan_ie_vhtop *vhtop;
245
246 htcap = (struct htcap_cmn_ie *)
247 util_scan_entry_htcap(scan_params);
248 htinfo = (struct wlan_ie_htinfo_cmn *)
249 util_scan_entry_htinfo(scan_params);
250 vhtop = (struct wlan_ie_vhtop *)
251 util_scan_entry_vhtop(scan_params);
252
253 if (htcap)
254 ht_cap = le16toh(htcap->hc_cap);
255
256 if (htcap && htinfo) {
257 if ((ht_cap & WLAN_HTCAP_C_CHWIDTH40) &&
258 (htinfo->hi_extchoff == WLAN_HTINFO_EXTOFFSET_ABOVE))
259 phymode = WLAN_PHYMODE_11NG_HT40PLUS;
260 else if ((ht_cap & WLAN_HTCAP_C_CHWIDTH40) &&
261 (htinfo->hi_extchoff == WLAN_HTINFO_EXTOFFSET_BELOW))
262 phymode = WLAN_PHYMODE_11NG_HT40MINUS;
263 else
264 phymode = WLAN_PHYMODE_11NG_HT20;
265 } else if (util_scan_entry_xrates(scan_params)) {
266 /* only 11G stations will have more than 8 rates */
267 phymode = WLAN_PHYMODE_11G;
268 } else {
269 /* Some mischievous g-only APs do not set extended rates */
270 if (util_scan_entry_rates(scan_params)) {
271 if (util_is_pureg_rate(&scan_params->ie_list.rates[2],
272 scan_params->ie_list.rates[1]))
273 phymode = WLAN_PHYMODE_11G;
274 else
275 phymode = WLAN_PHYMODE_11B;
276 } else {
277 phymode = WLAN_PHYMODE_11B;
278 }
279 }
280
281 return phymode;
282}
283
284static QDF_STATUS
285util_scan_parse_chan_switch_wrapper_ie(struct scan_cache_entry *scan_params,
286 struct ie_header *sub_ie, qdf_size_t sub_ie_len)
287{
288 /* Walk through to check nothing is malformed */
289 while (sub_ie_len >= sizeof(struct ie_header)) {
290 /* At least one more header is present */
291 sub_ie_len -= sizeof(struct ie_header);
292
293 if (sub_ie->ie_len == 0) {
294 sub_ie += 1;
295 continue;
296 }
297 if (sub_ie_len < sub_ie->ie_len) {
298 scm_err("Incomplete corrupted IE:%x",
299 WLAN_ELEMID_CHAN_SWITCH_WRAP);
300 return QDF_STATUS_E_INVAL;
301 }
302 switch (sub_ie->ie_id) {
303 case WLAN_ELEMID_COUNTRY:
304 scan_params->ie_list.country = (uint8_t *)sub_ie;
305 break;
306 case WLAN_ELEMID_WIDE_BAND_CHAN_SWITCH:
307 scan_params->ie_list.widebw = (uint8_t *)sub_ie;
308 break;
309 case WLAN_ELEMID_VHT_TX_PWR_ENVLP:
310 scan_params->ie_list.txpwrenvlp = (uint8_t *)sub_ie;
311 break;
312 }
313 /* Consume sub info element */
314 sub_ie_len -= sub_ie->ie_len;
315 /* go to next Sub IE */
316 sub_ie = (struct ie_header *)
317 (((uint8_t *) sub_ie) +
318 sizeof(struct ie_header) + sub_ie->ie_len);
319 }
320
321 return QDF_STATUS_SUCCESS;
322}
323
Om Prakash Tripathi1d1525d2017-09-08 13:59:34 +0530324bool
Abhishek Singh4caf1a92017-02-21 15:01:08 +0530325util_scan_is_hidden_ssid(struct ie_ssid *ssid)
326{
327 uint8_t i;
328
329 /*
330 * We flag this as Hidden SSID if the Length is 0
331 * of the SSID only contains 0's
332 */
333 if (!ssid || !ssid->ssid_len)
334 return true;
335
336 for (i = 0; i < ssid->ssid_len; i++)
337 if (ssid->ssid[i] != 0)
338 return false;
339
340 /* All 0's */
341 return true;
342}
343
344static void
Venkateswara Swamy Bandaru851184b2017-04-25 11:02:39 +0530345util_scan_parse_extn_ie(struct scan_cache_entry *scan_params,
346 struct ie_header *ie)
347{
348 struct extn_ie_header *extn_ie = (struct extn_ie_header *) ie;
349
350 switch (extn_ie->ie_extn_id) {
351 case WLAN_EXTN_ELEMID_SRP:
Gyanranjan Hazarikab5d426d2017-08-22 21:45:07 -0700352 scan_params->ie_list.srp = (uint8_t *)ie;
353 break;
354 case WLAN_EXTN_ELEMID_HECAP:
355 scan_params->ie_list.hecap = (uint8_t *)ie;
356 break;
357 case WLAN_EXTN_ELEMID_HEOP:
358 scan_params->ie_list.heop = (uint8_t *)ie;
Venkateswara Swamy Bandaru851184b2017-04-25 11:02:39 +0530359 break;
360 default:
361 break;
362 }
363}
364
365static void
Abhishek Singh4caf1a92017-02-21 15:01:08 +0530366util_scan_parse_vendor_ie(struct scan_cache_entry *scan_params,
367 struct ie_header *ie)
368{
369
370 if (scan_params->ie_list.vendor == NULL)
371 scan_params->ie_list.vendor = (uint8_t *)ie;
372
373 if (is_wpa_oui((uint8_t *)ie)) {
374 scan_params->ie_list.wpa = (uint8_t *)ie;
375 } else if (is_wps_oui((uint8_t *)ie)) {
376 scan_params->ie_list.wps = (uint8_t *)ie;
377 /* WCN IE should be a subset of WPS IE */
378 if (is_wcn_oui((uint8_t *)ie))
379 scan_params->ie_list.wcn = (uint8_t *)ie;
380 } else if (is_wme_param((uint8_t *)ie)) {
381 scan_params->ie_list.wmeparam = (uint8_t *)ie;
382 } else if (is_wme_info((uint8_t *)ie)) {
383 scan_params->ie_list.wmeinfo = (uint8_t *)ie;
384 } else if (is_atheros_oui((uint8_t *)ie)) {
385 scan_params->ie_list.athcaps = (uint8_t *)ie;
386 } else if (is_atheros_extcap_oui((uint8_t *)ie)) {
387 scan_params->ie_list.athextcaps = (uint8_t *)ie;
388 } else if (is_sfa_oui((uint8_t *)ie)) {
389 scan_params->ie_list.sfa = (uint8_t *)ie;
390 } else if (is_p2p_oui((uint8_t *)ie)) {
391 scan_params->ie_list.p2p = (uint8_t *)ie;
Bharat Bhushan Chakravarty145d3932017-03-20 12:52:16 -0700392 } else if (is_qca_son_oui((uint8_t *)ie,
393 QCA_OUI_WHC_AP_INFO_SUBTYPE)) {
Abhishek Singh4caf1a92017-02-21 15:01:08 +0530394 scan_params->ie_list.sonadv = (uint8_t *)ie;
395 } else if (is_ht_cap((uint8_t *)ie)) {
396 /* we only care if there isn't already an HT IE (ANA) */
397 if (scan_params->ie_list.htcap == NULL)
398 scan_params->ie_list.htcap =
399 (uint8_t *)&(((struct wlan_vendor_ie_htcap *)ie)->ie);
400 } else if (is_ht_info((uint8_t *)ie)) {
401 /* we only care if there isn't already an HT IE (ANA) */
402 if (scan_params->ie_list.htinfo == NULL)
403 scan_params->ie_list.htinfo =
404 (uint8_t *)&(((struct wlan_vendor_ie_htinfo *)
405 ie)->hi_ie);
406 } else if (is_interop_vht((uint8_t *)ie) &&
407 !(scan_params->ie_list.vhtop)) {
408 /* location where Interop Vht Cap IE and VHT OP IE Present */
409 scan_params->ie_list.vhtcap = (((uint8_t *)(ie)) + 7);
410 scan_params->ie_list.vhtop = (((uint8_t *)(ie)) + 21);
411 } else if (is_bwnss_oui((uint8_t *)ie)) {
412 /*
413 * Bandwidth-NSS map has sub-type & version.
414 * hence copy data just after version byte
415 */
416 scan_params->ie_list.bwnss_map = (((uint8_t *)ie) + 8);
417 }
418}
419
420static QDF_STATUS
421util_scan_populate_bcn_ie_list(struct scan_cache_entry *scan_params)
422{
423 struct ie_header *ie, *sub_ie;
424 uint32_t ie_len, sub_ie_len;
425 QDF_STATUS status;
426
427 ie_len = util_scan_entry_ie_len(scan_params);
428 ie = (struct ie_header *)
429 util_scan_entry_ie_data(scan_params);
430
431 while (ie_len >= sizeof(struct ie_header)) {
432 ie_len -= sizeof(struct ie_header);
433
434 if (!ie->ie_len) {
435 ie += 1;
436 continue;
437 }
438
439 if (ie_len < ie->ie_len) {
440 scm_err("Incomplete corrupted IE:%x",
441 ie->ie_id);
442 return QDF_STATUS_E_INVAL;
443 }
444
445 switch (ie->ie_id) {
446 case WLAN_ELEMID_SSID:
447 scan_params->ie_list.ssid = (uint8_t *)ie;
448 break;
449 case WLAN_ELEMID_RATES:
450 scan_params->ie_list.rates = (uint8_t *)ie;
451 break;
452 case WLAN_ELEMID_DSPARMS:
453 scan_params->channel.chan_idx =
454 ((struct ds_ie *)ie)->cur_chan;
455 break;
456 case WLAN_ELEMID_TIM:
457 scan_params->ie_list.tim = (uint8_t *)ie;
458 scan_params->dtim_period =
459 ((struct wlan_tim_ie *)ie)->tim_period;
460 break;
461 case WLAN_ELEMID_COUNTRY:
462 scan_params->ie_list.country = (uint8_t *)ie;
463 break;
464 case WLAN_ELEMID_QBSS_LOAD:
465 scan_params->ie_list.qbssload = (uint8_t *)ie;
466 break;
467 case WLAN_ELEMID_CHANSWITCHANN:
468 scan_params->ie_list.csa = (uint8_t *)ie;
469 break;
470 case WLAN_ELEMID_IBSSDFS:
471 scan_params->ie_list.ibssdfs = (uint8_t *)ie;
472 break;
473 case WLAN_ELEMID_QUIET:
474 scan_params->ie_list.quiet = (uint8_t *)ie;
475 break;
476 case WLAN_ELEMID_ERP:
477 scan_params->erp = ((struct erp_ie *)ie)->value;
478 break;
479 case WLAN_ELEMID_HTCAP_ANA:
480 scan_params->ie_list.htcap =
481 (uint8_t *)&(((struct htcap_ie *)ie)->ie);
482 break;
483 case WLAN_ELEMID_RSN:
484 scan_params->ie_list.rsn = (uint8_t *)ie;
485 break;
486 case WLAN_ELEMID_XRATES:
487 scan_params->ie_list.xrates = (uint8_t *)ie;
488 break;
489 case WLAN_ELEMID_EXTCHANSWITCHANN:
490 scan_params->ie_list.xcsa = (uint8_t *)ie;
491 break;
492 case WLAN_ELEMID_SECCHANOFFSET:
493 scan_params->ie_list.secchanoff = (uint8_t *)ie;
494 break;
495 case WLAN_ELEMID_HTINFO_ANA:
496 scan_params->ie_list.htinfo =
497 (uint8_t *)&(((struct wlan_ie_htinfo *) ie)->hi_ie);
498 scan_params->channel.chan_idx =
499 ((struct wlan_ie_htinfo_cmn *)
500 (scan_params->ie_list.htinfo))->hi_ctrlchannel;
501 break;
502 case WLAN_ELEMID_WAPI:
503 scan_params->ie_list.wapi = (uint8_t *)ie;
504 break;
505 case WLAN_ELEMID_XCAPS:
506 scan_params->ie_list.extcaps = (uint8_t *)ie;
507 break;
508 case WLAN_ELEMID_VHTCAP:
509 scan_params->ie_list.vhtcap = (uint8_t *)ie;
510 break;
511 case WLAN_ELEMID_VHTOP:
512 scan_params->ie_list.vhtop = (uint8_t *)ie;
513 break;
514 case WLAN_ELEMID_OP_MODE_NOTIFY:
515 scan_params->ie_list.opmode = (uint8_t *)ie;
516 break;
517 case WLAN_ELEMID_MOBILITY_DOMAIN:
518 scan_params->ie_list.mdie = (uint8_t *)ie;
519 break;
520 case WLAN_ELEMID_VENDOR:
521 util_scan_parse_vendor_ie(scan_params,
522 ie);
523 break;
524 case WLAN_ELEMID_CHAN_SWITCH_WRAP:
525 scan_params->ie_list.cswrp = (uint8_t *)ie;
526 /* Go to next sub IE */
527 sub_ie = (struct ie_header *)
528 (((uint8_t *)ie) + sizeof(struct ie_header));
529 sub_ie_len = ie->ie_len;
530 status =
531 util_scan_parse_chan_switch_wrapper_ie(
532 scan_params, sub_ie, sub_ie_len);
533 if (QDF_IS_STATUS_ERROR(status)) {
534 scm_err("failed to parse chan_switch_wrapper_ie");
535 return status;
536 }
537 break;
Kapil Guptade02d4f2017-06-05 12:37:59 +0530538 case WLAN_ELEMID_FILS_INDICATION:
539 scan_params->ie_list.fils_indication = (uint8_t *)ie;
540 break;
Venkateswara Swamy Bandaru851184b2017-04-25 11:02:39 +0530541 case WLAN_ELEMID_EXTN_ELEM:
542 util_scan_parse_extn_ie(scan_params, ie);
543 break;
Abhishek Singh4caf1a92017-02-21 15:01:08 +0530544 default:
545 break;
546 }
547
548 /* Consume info element */
549 ie_len -= ie->ie_len;
550 /* Go to next IE */
551 ie = (struct ie_header *)
552 (((uint8_t *) ie) +
553 sizeof(struct ie_header) +
554 ie->ie_len);
555 }
556
557 return QDF_STATUS_SUCCESS;
558}
559
560struct scan_cache_entry *
561util_scan_unpack_beacon_frame(uint8_t *frame,
562 qdf_size_t frame_len, uint32_t frm_subtype,
563 struct mgmt_rx_event_params *rx_param)
564{
565 struct wlan_frame_hdr *hdr;
566 struct wlan_bcn_frame *bcn;
567 QDF_STATUS status;
568 struct ie_ssid *ssid;
569 struct scan_cache_entry *scan_entry = NULL;
570
571 scan_entry = qdf_mem_malloc(sizeof(*scan_entry));
572 if (!scan_entry) {
573 scm_err("failed to allocate memory for scan_entry");
574 return NULL;
575 }
576 scan_entry->raw_frame.ptr =
577 qdf_mem_malloc(frame_len);
578 if (!scan_entry->raw_frame.ptr) {
579 scm_err("failed to allocate memory for frame");
580 qdf_mem_free(scan_entry);
581 return NULL;
582 }
583
584 bcn = (struct wlan_bcn_frame *)
585 (frame + sizeof(*hdr));
586 hdr = (struct wlan_frame_hdr *)frame;
587
588 scan_entry->frm_subtype = frm_subtype;
589 qdf_mem_copy(scan_entry->bssid.bytes,
590 hdr->i_addr3, QDF_MAC_ADDR_SIZE);
591 /* Scr addr */
592 qdf_mem_copy(scan_entry->mac_addr.bytes,
593 hdr->i_addr2, QDF_MAC_ADDR_SIZE);
594 scan_entry->seq_num =
595 (le16toh(*(uint16_t *)hdr->i_seq) >> WLAN_SEQ_SEQ_SHIFT);
596
597 scan_entry->rssi_raw = rx_param->rssi;
Om Prakash Tripathi6af738b2017-08-22 15:46:38 +0530598 scan_entry->avg_rssi = WLAN_RSSI_IN(scan_entry->rssi_raw);
Abhishek Singh4caf1a92017-02-21 15:01:08 +0530599 scan_entry->tsf_delta = rx_param->tsf_delta;
600
601 /* store jiffies */
602 scan_entry->rrm_parent_tsf = (u_int32_t) qdf_system_ticks();
603
604 scan_entry->bcn_int = le16toh(bcn->beacon_interval);
605
606 /*
607 * In case if the beacon dosnt have
608 * valid beacon interval falback to def
609 */
610 if (!scan_entry->bcn_int)
611 scan_entry->bcn_int = 100;
612 scan_entry->cap_info.value = le16toh(bcn->capability.value);
613 qdf_mem_copy(scan_entry->tsf_info.data,
614 bcn->timestamp, 8);
615 scan_entry->erp = ERP_NON_ERP_PRESENT;
616
Om Prakash Tripathicdcbb392017-04-18 18:51:20 +0530617 scan_entry->scan_entry_time =
618 qdf_mc_timer_get_system_time();
Abhishek Singh4caf1a92017-02-21 15:01:08 +0530619
620 scan_entry->raw_frame.len = frame_len;
621 qdf_mem_copy(scan_entry->raw_frame.ptr,
622 frame, frame_len);
623 status = util_scan_populate_bcn_ie_list(scan_entry);
624 if (QDF_IS_STATUS_ERROR(status)) {
625 scm_err("failed to parse beacon IE");
626 qdf_mem_free(scan_entry->raw_frame.ptr);
627 qdf_mem_free(scan_entry);
628 return NULL;
629 }
630
631 if (!scan_entry->ie_list.rates) {
632 qdf_mem_free(scan_entry->raw_frame.ptr);
633 qdf_mem_free(scan_entry);
634 return NULL;
635 }
636
637 ssid = (struct ie_ssid *)
638 scan_entry->ie_list.ssid;
639
640 if (ssid && (ssid->ssid_len > WLAN_SSID_MAX_LEN)) {
641 qdf_mem_free(scan_entry->raw_frame.ptr);
642 qdf_mem_free(scan_entry);
643 return NULL;
644 }
645
646 if (scan_entry->ie_list.p2p)
647 scan_entry->is_p2p = true;
648
649 /* If no channel info is present in beacon use meta channel */
650 if (!scan_entry->channel.chan_idx) {
651 scan_entry->channel.chan_idx =
652 rx_param->channel;
653 } else if (rx_param->channel !=
654 scan_entry->channel.chan_idx) {
655 scan_entry->channel_mismatch = true;
656 }
657
658 if (util_scan_is_hidden_ssid(ssid)) {
659 scan_entry->ie_list.ssid = NULL;
660 } else {
661 qdf_mem_copy(scan_entry->ssid.ssid,
662 ssid->ssid, WLAN_SSID_MAX_LEN);
663 scan_entry->ssid.length = ssid->ssid_len;
664 scan_entry->hidden_ssid_timestamp =
665 scan_entry->scan_entry_time;
666 }
667
668 if (WLAN_CHAN_IS_5GHZ(scan_entry->channel.chan_idx))
669 scan_entry->phy_mode = util_scan_get_phymode_5g(scan_entry);
670 else
671 scan_entry->phy_mode = util_scan_get_phymode_2g(scan_entry);
672
673 /* TODO calculate channel struct */
674 return scan_entry;
675}
Om Prakash Tripathic3fcb682017-08-01 18:24:55 +0530676
677QDF_STATUS
678util_scan_entry_update_mlme_info(struct wlan_objmgr_pdev *pdev,
679 struct scan_cache_entry *scan_entry)
680{
681
682 if (!pdev || !scan_entry) {
683 scm_err("pdev 0x%p, scan_entry: 0x%p", pdev, scan_entry);
684 return QDF_STATUS_E_INVAL;
685 }
686
687 return scm_update_scan_mlme_info(pdev, scan_entry);
688}