2 * Driver interaction with Linux nl80211/cfg80211 - Scanning
3 * Copyright(c) 2015 Intel Deutschland GmbH
4 * Copyright (c) 2002-2014, Jouni Malinen <j@w1.fi>
5 * Copyright (c) 2007, Johannes Berg <johannes@sipsolutions.net>
6 * Copyright (c) 2009-2010, Atheros Communications
8 * This software may be distributed under the terms of the BSD license.
9 * See README for more details.
13 #include <netlink/genl/genl.h>
15 #include "utils/common.h"
16 #include "utils/eloop.h"
17 #include "common/ieee802_11_defs.h"
18 #include "common/qca-vendor.h"
19 #include "driver_nl80211.h"
22 static int get_noise_for_scan_results(struct nl_msg *msg, void *arg)
24 struct nlattr *tb[NL80211_ATTR_MAX + 1];
25 struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
26 struct nlattr *sinfo[NL80211_SURVEY_INFO_MAX + 1];
27 static struct nla_policy survey_policy[NL80211_SURVEY_INFO_MAX + 1] = {
28 [NL80211_SURVEY_INFO_FREQUENCY] = { .type = NLA_U32 },
29 [NL80211_SURVEY_INFO_NOISE] = { .type = NLA_U8 },
31 struct wpa_scan_results *scan_results = arg;
32 struct wpa_scan_res *scan_res;
35 nla_parse(tb, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
36 genlmsg_attrlen(gnlh, 0), NULL);
38 if (!tb[NL80211_ATTR_SURVEY_INFO]) {
39 wpa_printf(MSG_DEBUG, "nl80211: Survey data missing");
43 if (nla_parse_nested(sinfo, NL80211_SURVEY_INFO_MAX,
44 tb[NL80211_ATTR_SURVEY_INFO],
46 wpa_printf(MSG_DEBUG, "nl80211: Failed to parse nested "
51 if (!sinfo[NL80211_SURVEY_INFO_NOISE])
54 if (!sinfo[NL80211_SURVEY_INFO_FREQUENCY])
57 for (i = 0; i < scan_results->num; ++i) {
58 scan_res = scan_results->res[i];
61 if ((int) nla_get_u32(sinfo[NL80211_SURVEY_INFO_FREQUENCY]) !=
64 if (!(scan_res->flags & WPA_SCAN_NOISE_INVALID))
66 scan_res->noise = (s8)
67 nla_get_u8(sinfo[NL80211_SURVEY_INFO_NOISE]);
68 scan_res->flags &= ~WPA_SCAN_NOISE_INVALID;
75 static int nl80211_get_noise_for_scan_results(
76 struct wpa_driver_nl80211_data *drv,
77 struct wpa_scan_results *scan_res)
81 msg = nl80211_drv_msg(drv, NLM_F_DUMP, NL80211_CMD_GET_SURVEY);
82 return send_and_recv_msgs(drv, msg, get_noise_for_scan_results,
88 * wpa_driver_nl80211_scan_timeout - Scan timeout to report scan completion
89 * @eloop_ctx: Driver private data
90 * @timeout_ctx: ctx argument given to wpa_driver_nl80211_init()
92 * This function can be used as registered timeout when starting a scan to
93 * generate a scan completed event if the driver does not report this.
95 void wpa_driver_nl80211_scan_timeout(void *eloop_ctx, void *timeout_ctx)
97 struct wpa_driver_nl80211_data *drv = eloop_ctx;
98 if (drv->ap_scan_as_station != NL80211_IFTYPE_UNSPECIFIED) {
99 wpa_driver_nl80211_set_mode(drv->first_bss,
100 drv->ap_scan_as_station);
101 drv->ap_scan_as_station = NL80211_IFTYPE_UNSPECIFIED;
103 wpa_printf(MSG_DEBUG, "Scan timeout - try to get results");
104 wpa_supplicant_event(timeout_ctx, EVENT_SCAN_RESULTS, NULL);
108 static struct nl_msg *
109 nl80211_scan_common(struct i802_bss *bss, u8 cmd,
110 struct wpa_driver_scan_params *params)
112 struct wpa_driver_nl80211_data *drv = bss->drv;
117 msg = nl80211_cmd_msg(bss, 0, cmd);
121 if (params->num_ssids) {
122 struct nlattr *ssids;
124 ssids = nla_nest_start(msg, NL80211_ATTR_SCAN_SSIDS);
127 for (i = 0; i < params->num_ssids; i++) {
128 wpa_hexdump_ascii(MSG_MSGDUMP, "nl80211: Scan SSID",
129 params->ssids[i].ssid,
130 params->ssids[i].ssid_len);
131 if (nla_put(msg, i + 1, params->ssids[i].ssid_len,
132 params->ssids[i].ssid))
135 nla_nest_end(msg, ssids);
137 wpa_printf(MSG_DEBUG, "nl80211: Passive scan requested");
140 if (params->extra_ies) {
141 wpa_hexdump(MSG_MSGDUMP, "nl80211: Scan extra IEs",
142 params->extra_ies, params->extra_ies_len);
143 if (nla_put(msg, NL80211_ATTR_IE, params->extra_ies_len,
149 struct nlattr *freqs;
150 freqs = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
153 for (i = 0; params->freqs[i]; i++) {
154 wpa_printf(MSG_MSGDUMP, "nl80211: Scan frequency %u "
155 "MHz", params->freqs[i]);
156 if (nla_put_u32(msg, i + 1, params->freqs[i]))
159 nla_nest_end(msg, freqs);
162 os_free(drv->filter_ssids);
163 drv->filter_ssids = params->filter_ssids;
164 params->filter_ssids = NULL;
165 drv->num_filter_ssids = params->num_filter_ssids;
167 if (params->only_new_results) {
168 wpa_printf(MSG_DEBUG, "nl80211: Add NL80211_SCAN_FLAG_FLUSH");
169 scan_flags |= NL80211_SCAN_FLAG_FLUSH;
172 if (params->low_priority && drv->have_low_prio_scan) {
173 wpa_printf(MSG_DEBUG,
174 "nl80211: Add NL80211_SCAN_FLAG_LOW_PRIORITY");
175 scan_flags |= NL80211_SCAN_FLAG_LOW_PRIORITY;
178 if (params->mac_addr_rand) {
179 wpa_printf(MSG_DEBUG,
180 "nl80211: Add NL80211_SCAN_FLAG_RANDOM_ADDR");
181 scan_flags |= NL80211_SCAN_FLAG_RANDOM_ADDR;
183 if (params->mac_addr) {
184 wpa_printf(MSG_DEBUG, "nl80211: MAC address: " MACSTR,
185 MAC2STR(params->mac_addr));
186 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN,
191 if (params->mac_addr_mask) {
192 wpa_printf(MSG_DEBUG, "nl80211: MAC address mask: "
193 MACSTR, MAC2STR(params->mac_addr_mask));
194 if (nla_put(msg, NL80211_ATTR_MAC_MASK, ETH_ALEN,
195 params->mac_addr_mask))
201 nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, scan_flags))
213 * wpa_driver_nl80211_scan - Request the driver to initiate scan
214 * @bss: Pointer to private driver data from wpa_driver_nl80211_init()
215 * @params: Scan parameters
216 * Returns: 0 on success, -1 on failure
218 int wpa_driver_nl80211_scan(struct i802_bss *bss,
219 struct wpa_driver_scan_params *params)
221 struct wpa_driver_nl80211_data *drv = bss->drv;
222 int ret = -1, timeout;
223 struct nl_msg *msg = NULL;
225 wpa_dbg(drv->ctx, MSG_DEBUG, "nl80211: scan request");
226 drv->scan_for_auth = 0;
231 msg = nl80211_scan_common(bss, NL80211_CMD_TRIGGER_SCAN, params);
235 if (params->p2p_probe) {
236 struct nlattr *rates;
238 wpa_printf(MSG_DEBUG, "nl80211: P2P probe - mask SuppRates");
240 rates = nla_nest_start(msg, NL80211_ATTR_SCAN_SUPP_RATES);
245 * Remove 2.4 GHz rates 1, 2, 5.5, 11 Mbps from supported rates
246 * by masking out everything else apart from the OFDM rates 6,
247 * 9, 12, 18, 24, 36, 48, 54 Mbps from non-MCS rates. All 5 GHz
248 * rates are left enabled.
250 if (nla_put(msg, NL80211_BAND_2GHZ, 8,
251 "\x0c\x12\x18\x24\x30\x48\x60\x6c"))
253 nla_nest_end(msg, rates);
255 if (nla_put_flag(msg, NL80211_ATTR_TX_NO_CCK_RATE))
259 ret = send_and_recv_msgs(drv, msg, NULL, NULL);
262 wpa_printf(MSG_DEBUG, "nl80211: Scan trigger failed: ret=%d "
263 "(%s)", ret, strerror(-ret));
264 if (drv->hostapd && is_ap_interface(drv->nlmode)) {
265 enum nl80211_iftype old_mode = drv->nlmode;
268 * mac80211 does not allow scan requests in AP mode, so
269 * try to do this in station mode.
271 if (wpa_driver_nl80211_set_mode(
272 bss, NL80211_IFTYPE_STATION))
275 if (wpa_driver_nl80211_scan(bss, params)) {
276 wpa_driver_nl80211_set_mode(bss, old_mode);
280 /* Restore AP mode when processing scan results */
281 drv->ap_scan_as_station = old_mode;
287 drv->scan_state = SCAN_REQUESTED;
288 /* Not all drivers generate "scan completed" wireless event, so try to
289 * read results after a timeout. */
291 if (drv->scan_complete_events) {
293 * The driver seems to deliver events to notify when scan is
294 * complete, so use longer timeout to avoid race conditions
295 * with scanning and following association request.
299 wpa_printf(MSG_DEBUG, "Scan requested (ret=%d) - scan timeout %d "
300 "seconds", ret, timeout);
301 eloop_cancel_timeout(wpa_driver_nl80211_scan_timeout, drv, drv->ctx);
302 eloop_register_timeout(timeout, 0, wpa_driver_nl80211_scan_timeout,
304 drv->last_scan_cmd = NL80211_CMD_TRIGGER_SCAN;
313 nl80211_sched_scan_add_scan_plans(struct wpa_driver_nl80211_data *drv,
315 struct wpa_driver_scan_params *params)
317 struct nlattr *plans;
318 struct sched_scan_plan *scan_plans = params->sched_scan_plans;
321 plans = nla_nest_start(msg, NL80211_ATTR_SCHED_SCAN_PLANS);
325 for (i = 0; i < params->sched_scan_plans_num; i++) {
326 struct nlattr *plan = nla_nest_start(msg, i + 1);
331 if (!scan_plans[i].interval ||
332 scan_plans[i].interval >
333 drv->capa.max_sched_scan_plan_interval) {
334 wpa_printf(MSG_DEBUG,
335 "nl80211: sched scan plan no. %u: Invalid interval: %u",
336 i, scan_plans[i].interval);
340 if (nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL,
341 scan_plans[i].interval))
344 if (scan_plans[i].iterations >
345 drv->capa.max_sched_scan_plan_iterations) {
346 wpa_printf(MSG_DEBUG,
347 "nl80211: sched scan plan no. %u: Invalid number of iterations: %u",
348 i, scan_plans[i].iterations);
352 if (scan_plans[i].iterations &&
353 nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS,
354 scan_plans[i].iterations))
357 nla_nest_end(msg, plan);
360 * All the scan plans must specify the number of iterations
361 * except the last plan, which will run infinitely. So if the
362 * number of iterations is not specified, this ought to be the
365 if (!scan_plans[i].iterations)
369 if (i != params->sched_scan_plans_num - 1) {
370 wpa_printf(MSG_DEBUG,
371 "nl80211: All sched scan plans but the last must specify number of iterations");
375 nla_nest_end(msg, plans);
381 * wpa_driver_nl80211_sched_scan - Initiate a scheduled scan
382 * @priv: Pointer to private driver data from wpa_driver_nl80211_init()
383 * @params: Scan parameters
384 * Returns: 0 on success, -1 on failure or if not supported
386 int wpa_driver_nl80211_sched_scan(void *priv,
387 struct wpa_driver_scan_params *params)
389 struct i802_bss *bss = priv;
390 struct wpa_driver_nl80211_data *drv = bss->drv;
395 wpa_dbg(drv->ctx, MSG_DEBUG, "nl80211: sched_scan request");
398 if (!drv->capa.sched_scan_supported)
399 return android_pno_start(bss, params);
402 if (!params->sched_scan_plans_num ||
403 params->sched_scan_plans_num > drv->capa.max_sched_scan_plans) {
404 wpa_printf(MSG_ERROR,
405 "nl80211: Invalid number of sched scan plans: %u",
406 params->sched_scan_plans_num);
410 msg = nl80211_scan_common(bss, NL80211_CMD_START_SCHED_SCAN, params);
414 if (drv->capa.max_sched_scan_plan_iterations) {
415 if (nl80211_sched_scan_add_scan_plans(drv, msg, params))
418 if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL,
419 params->sched_scan_plans[0].interval * 1000))
423 if ((drv->num_filter_ssids &&
424 (int) drv->num_filter_ssids <= drv->capa.max_match_sets) ||
425 params->filter_rssi) {
426 struct nlattr *match_sets;
427 match_sets = nla_nest_start(msg, NL80211_ATTR_SCHED_SCAN_MATCH);
428 if (match_sets == NULL)
431 for (i = 0; i < drv->num_filter_ssids; i++) {
432 struct nlattr *match_set_ssid;
433 wpa_hexdump_ascii(MSG_MSGDUMP,
434 "nl80211: Sched scan filter SSID",
435 drv->filter_ssids[i].ssid,
436 drv->filter_ssids[i].ssid_len);
438 match_set_ssid = nla_nest_start(msg, i + 1);
439 if (match_set_ssid == NULL ||
440 nla_put(msg, NL80211_ATTR_SCHED_SCAN_MATCH_SSID,
441 drv->filter_ssids[i].ssid_len,
442 drv->filter_ssids[i].ssid) ||
443 (params->filter_rssi &&
445 NL80211_SCHED_SCAN_MATCH_ATTR_RSSI,
446 params->filter_rssi)))
449 nla_nest_end(msg, match_set_ssid);
453 * Due to backward compatibility code, newer kernels treat this
454 * matchset (with only an RSSI filter) as the default for all
455 * other matchsets, unless it's the only one, in which case the
456 * matchset will actually allow all SSIDs above the RSSI.
458 if (params->filter_rssi) {
459 struct nlattr *match_set_rssi;
460 match_set_rssi = nla_nest_start(msg, 0);
461 if (match_set_rssi == NULL ||
462 nla_put_u32(msg, NL80211_SCHED_SCAN_MATCH_ATTR_RSSI,
463 params->filter_rssi))
465 wpa_printf(MSG_MSGDUMP,
466 "nl80211: Sched scan RSSI filter %d dBm",
467 params->filter_rssi);
468 nla_nest_end(msg, match_set_rssi);
471 nla_nest_end(msg, match_sets);
474 ret = send_and_recv_msgs(drv, msg, NULL, NULL);
476 /* TODO: if we get an error here, we should fall back to normal scan */
480 wpa_printf(MSG_DEBUG, "nl80211: Sched scan start failed: "
481 "ret=%d (%s)", ret, strerror(-ret));
485 wpa_printf(MSG_DEBUG, "nl80211: Sched scan requested (ret=%d)", ret);
494 * wpa_driver_nl80211_stop_sched_scan - Stop a scheduled scan
495 * @priv: Pointer to private driver data from wpa_driver_nl80211_init()
496 * Returns: 0 on success, -1 on failure or if not supported
498 int wpa_driver_nl80211_stop_sched_scan(void *priv)
500 struct i802_bss *bss = priv;
501 struct wpa_driver_nl80211_data *drv = bss->drv;
506 if (!drv->capa.sched_scan_supported)
507 return android_pno_stop(bss);
510 msg = nl80211_drv_msg(drv, 0, NL80211_CMD_STOP_SCHED_SCAN);
511 ret = send_and_recv_msgs(drv, msg, NULL, NULL);
513 wpa_printf(MSG_DEBUG,
514 "nl80211: Sched scan stop failed: ret=%d (%s)",
515 ret, strerror(-ret));
517 wpa_printf(MSG_DEBUG,
518 "nl80211: Sched scan stop sent");
525 const u8 * nl80211_get_ie(const u8 *ies, size_t ies_len, u8 ie)
535 while (end - pos > 1) {
536 if (2 + pos[1] > end - pos)
547 static int nl80211_scan_filtered(struct wpa_driver_nl80211_data *drv,
548 const u8 *ie, size_t ie_len)
553 if (drv->filter_ssids == NULL)
556 ssid = nl80211_get_ie(ie, ie_len, WLAN_EID_SSID);
560 for (i = 0; i < drv->num_filter_ssids; i++) {
561 if (ssid[1] == drv->filter_ssids[i].ssid_len &&
562 os_memcmp(ssid + 2, drv->filter_ssids[i].ssid, ssid[1]) ==
571 int bss_info_handler(struct nl_msg *msg, void *arg)
573 struct nlattr *tb[NL80211_ATTR_MAX + 1];
574 struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
575 struct nlattr *bss[NL80211_BSS_MAX + 1];
576 static struct nla_policy bss_policy[NL80211_BSS_MAX + 1] = {
577 [NL80211_BSS_BSSID] = { .type = NLA_UNSPEC },
578 [NL80211_BSS_FREQUENCY] = { .type = NLA_U32 },
579 [NL80211_BSS_TSF] = { .type = NLA_U64 },
580 [NL80211_BSS_BEACON_INTERVAL] = { .type = NLA_U16 },
581 [NL80211_BSS_CAPABILITY] = { .type = NLA_U16 },
582 [NL80211_BSS_INFORMATION_ELEMENTS] = { .type = NLA_UNSPEC },
583 [NL80211_BSS_SIGNAL_MBM] = { .type = NLA_U32 },
584 [NL80211_BSS_SIGNAL_UNSPEC] = { .type = NLA_U8 },
585 [NL80211_BSS_STATUS] = { .type = NLA_U32 },
586 [NL80211_BSS_SEEN_MS_AGO] = { .type = NLA_U32 },
587 [NL80211_BSS_BEACON_IES] = { .type = NLA_UNSPEC },
589 struct nl80211_bss_info_arg *_arg = arg;
590 struct wpa_scan_results *res = _arg->res;
591 struct wpa_scan_res **tmp;
592 struct wpa_scan_res *r;
593 const u8 *ie, *beacon_ie;
594 size_t ie_len, beacon_ie_len;
598 nla_parse(tb, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
599 genlmsg_attrlen(gnlh, 0), NULL);
600 if (!tb[NL80211_ATTR_BSS])
602 if (nla_parse_nested(bss, NL80211_BSS_MAX, tb[NL80211_ATTR_BSS],
605 if (bss[NL80211_BSS_STATUS]) {
606 enum nl80211_bss_status status;
607 status = nla_get_u32(bss[NL80211_BSS_STATUS]);
608 if (status == NL80211_BSS_STATUS_ASSOCIATED &&
609 bss[NL80211_BSS_FREQUENCY]) {
611 nla_get_u32(bss[NL80211_BSS_FREQUENCY]);
612 wpa_printf(MSG_DEBUG, "nl80211: Associated on %u MHz",
615 if (status == NL80211_BSS_STATUS_IBSS_JOINED &&
616 bss[NL80211_BSS_FREQUENCY]) {
618 nla_get_u32(bss[NL80211_BSS_FREQUENCY]);
619 wpa_printf(MSG_DEBUG, "nl80211: IBSS-joined on %u MHz",
622 if (status == NL80211_BSS_STATUS_ASSOCIATED &&
623 bss[NL80211_BSS_BSSID]) {
624 os_memcpy(_arg->assoc_bssid,
625 nla_data(bss[NL80211_BSS_BSSID]), ETH_ALEN);
626 wpa_printf(MSG_DEBUG, "nl80211: Associated with "
627 MACSTR, MAC2STR(_arg->assoc_bssid));
632 if (bss[NL80211_BSS_INFORMATION_ELEMENTS]) {
633 ie = nla_data(bss[NL80211_BSS_INFORMATION_ELEMENTS]);
634 ie_len = nla_len(bss[NL80211_BSS_INFORMATION_ELEMENTS]);
639 if (bss[NL80211_BSS_BEACON_IES]) {
640 beacon_ie = nla_data(bss[NL80211_BSS_BEACON_IES]);
641 beacon_ie_len = nla_len(bss[NL80211_BSS_BEACON_IES]);
647 if (nl80211_scan_filtered(_arg->drv, ie ? ie : beacon_ie,
648 ie ? ie_len : beacon_ie_len))
651 r = os_zalloc(sizeof(*r) + ie_len + beacon_ie_len);
654 if (bss[NL80211_BSS_BSSID])
655 os_memcpy(r->bssid, nla_data(bss[NL80211_BSS_BSSID]),
657 if (bss[NL80211_BSS_FREQUENCY])
658 r->freq = nla_get_u32(bss[NL80211_BSS_FREQUENCY]);
659 if (bss[NL80211_BSS_BEACON_INTERVAL])
660 r->beacon_int = nla_get_u16(bss[NL80211_BSS_BEACON_INTERVAL]);
661 if (bss[NL80211_BSS_CAPABILITY])
662 r->caps = nla_get_u16(bss[NL80211_BSS_CAPABILITY]);
663 r->flags |= WPA_SCAN_NOISE_INVALID;
664 if (bss[NL80211_BSS_SIGNAL_MBM]) {
665 r->level = nla_get_u32(bss[NL80211_BSS_SIGNAL_MBM]);
666 r->level /= 100; /* mBm to dBm */
667 r->flags |= WPA_SCAN_LEVEL_DBM | WPA_SCAN_QUAL_INVALID;
668 } else if (bss[NL80211_BSS_SIGNAL_UNSPEC]) {
669 r->level = nla_get_u8(bss[NL80211_BSS_SIGNAL_UNSPEC]);
670 r->flags |= WPA_SCAN_QUAL_INVALID;
672 r->flags |= WPA_SCAN_LEVEL_INVALID | WPA_SCAN_QUAL_INVALID;
673 if (bss[NL80211_BSS_TSF])
674 r->tsf = nla_get_u64(bss[NL80211_BSS_TSF]);
675 if (bss[NL80211_BSS_BEACON_TSF]) {
676 u64 tsf = nla_get_u64(bss[NL80211_BSS_BEACON_TSF]);
680 if (bss[NL80211_BSS_SEEN_MS_AGO])
681 r->age = nla_get_u32(bss[NL80211_BSS_SEEN_MS_AGO]);
683 pos = (u8 *) (r + 1);
685 os_memcpy(pos, ie, ie_len);
688 r->beacon_ie_len = beacon_ie_len;
690 os_memcpy(pos, beacon_ie, beacon_ie_len);
692 if (bss[NL80211_BSS_STATUS]) {
693 enum nl80211_bss_status status;
694 status = nla_get_u32(bss[NL80211_BSS_STATUS]);
696 case NL80211_BSS_STATUS_ASSOCIATED:
697 r->flags |= WPA_SCAN_ASSOCIATED;
705 * cfg80211 maintains separate BSS table entries for APs if the same
706 * BSSID,SSID pair is seen on multiple channels. wpa_supplicant does
707 * not use frequency as a separate key in the BSS table, so filter out
708 * duplicated entries. Prefer associated BSS entry in such a case in
709 * order to get the correct frequency into the BSS table. Similarly,
710 * prefer newer entries over older.
712 for (i = 0; i < res->num; i++) {
714 if (os_memcmp(res->res[i]->bssid, r->bssid, ETH_ALEN) != 0)
717 s1 = nl80211_get_ie((u8 *) (res->res[i] + 1),
718 res->res[i]->ie_len, WLAN_EID_SSID);
719 s2 = nl80211_get_ie((u8 *) (r + 1), r->ie_len, WLAN_EID_SSID);
720 if (s1 == NULL || s2 == NULL || s1[1] != s2[1] ||
721 os_memcmp(s1, s2, 2 + s1[1]) != 0)
724 /* Same BSSID,SSID was already included in scan results */
725 wpa_printf(MSG_DEBUG, "nl80211: Remove duplicated scan result "
726 "for " MACSTR, MAC2STR(r->bssid));
728 if (((r->flags & WPA_SCAN_ASSOCIATED) &&
729 !(res->res[i]->flags & WPA_SCAN_ASSOCIATED)) ||
730 r->age < res->res[i]->age) {
731 os_free(res->res[i]);
738 tmp = os_realloc_array(res->res, res->num + 1,
739 sizeof(struct wpa_scan_res *));
751 static void clear_state_mismatch(struct wpa_driver_nl80211_data *drv,
754 if (drv->capa.flags & WPA_DRIVER_FLAGS_SME) {
755 wpa_printf(MSG_DEBUG, "nl80211: Clear possible state "
756 "mismatch (" MACSTR ")", MAC2STR(addr));
757 wpa_driver_nl80211_mlme(drv, addr,
758 NL80211_CMD_DEAUTHENTICATE,
759 WLAN_REASON_PREV_AUTH_NOT_VALID, 1);
764 static void wpa_driver_nl80211_check_bss_status(
765 struct wpa_driver_nl80211_data *drv, struct wpa_scan_results *res)
769 for (i = 0; i < res->num; i++) {
770 struct wpa_scan_res *r = res->res[i];
772 if (r->flags & WPA_SCAN_ASSOCIATED) {
773 wpa_printf(MSG_DEBUG, "nl80211: Scan results "
774 "indicate BSS status with " MACSTR
777 if (is_sta_interface(drv->nlmode) &&
779 wpa_printf(MSG_DEBUG, "nl80211: Local state "
780 "(not associated) does not match "
782 clear_state_mismatch(drv, r->bssid);
783 } else if (is_sta_interface(drv->nlmode) &&
784 os_memcmp(drv->bssid, r->bssid, ETH_ALEN) !=
786 wpa_printf(MSG_DEBUG, "nl80211: Local state "
787 "(associated with " MACSTR ") does "
788 "not match with BSS state",
789 MAC2STR(drv->bssid));
790 clear_state_mismatch(drv, r->bssid);
791 clear_state_mismatch(drv, drv->bssid);
798 static struct wpa_scan_results *
799 nl80211_get_scan_results(struct wpa_driver_nl80211_data *drv)
802 struct wpa_scan_results *res;
804 struct nl80211_bss_info_arg arg;
806 res = os_zalloc(sizeof(*res));
809 if (!(msg = nl80211_cmd_msg(drv->first_bss, NLM_F_DUMP,
810 NL80211_CMD_GET_SCAN))) {
811 wpa_scan_results_free(res);
817 ret = send_and_recv_msgs(drv, msg, bss_info_handler, &arg);
819 wpa_printf(MSG_DEBUG, "nl80211: Received scan results (%lu "
820 "BSSes)", (unsigned long) res->num);
821 nl80211_get_noise_for_scan_results(drv, res);
824 wpa_printf(MSG_DEBUG, "nl80211: Scan result fetch failed: ret=%d "
825 "(%s)", ret, strerror(-ret));
826 wpa_scan_results_free(res);
832 * wpa_driver_nl80211_get_scan_results - Fetch the latest scan results
833 * @priv: Pointer to private wext data from wpa_driver_nl80211_init()
834 * Returns: Scan results on success, -1 on failure
836 struct wpa_scan_results * wpa_driver_nl80211_get_scan_results(void *priv)
838 struct i802_bss *bss = priv;
839 struct wpa_driver_nl80211_data *drv = bss->drv;
840 struct wpa_scan_results *res;
842 res = nl80211_get_scan_results(drv);
844 wpa_driver_nl80211_check_bss_status(drv, res);
849 void nl80211_dump_scan(struct wpa_driver_nl80211_data *drv)
851 struct wpa_scan_results *res;
854 res = nl80211_get_scan_results(drv);
856 wpa_printf(MSG_DEBUG, "nl80211: Failed to get scan results");
860 wpa_printf(MSG_DEBUG, "nl80211: Scan result dump");
861 for (i = 0; i < res->num; i++) {
862 struct wpa_scan_res *r = res->res[i];
863 wpa_printf(MSG_DEBUG, "nl80211: %d/%d " MACSTR "%s",
864 (int) i, (int) res->num, MAC2STR(r->bssid),
865 r->flags & WPA_SCAN_ASSOCIATED ? " [assoc]" : "");
868 wpa_scan_results_free(res);
872 int wpa_driver_nl80211_abort_scan(void *priv)
874 struct i802_bss *bss = priv;
875 struct wpa_driver_nl80211_data *drv = bss->drv;
879 wpa_printf(MSG_DEBUG, "nl80211: Abort scan");
880 msg = nl80211_cmd_msg(bss, 0, NL80211_CMD_ABORT_SCAN);
881 ret = send_and_recv_msgs(drv, msg, NULL, NULL);
883 wpa_printf(MSG_DEBUG, "nl80211: Abort scan failed: ret=%d (%s)",
884 ret, strerror(-ret));
891 #ifdef CONFIG_DRIVER_NL80211_QCA
893 static int scan_cookie_handler(struct nl_msg *msg, void *arg)
895 struct nlattr *tb[NL80211_ATTR_MAX + 1];
896 struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
899 nla_parse(tb, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
900 genlmsg_attrlen(gnlh, 0), NULL);
902 if (tb[NL80211_ATTR_VENDOR_DATA]) {
903 struct nlattr *nl_vendor = tb[NL80211_ATTR_VENDOR_DATA];
904 struct nlattr *tb_vendor[QCA_WLAN_VENDOR_ATTR_SCAN_MAX + 1];
906 nla_parse(tb_vendor, QCA_WLAN_VENDOR_ATTR_SCAN_MAX,
907 nla_data(nl_vendor), nla_len(nl_vendor), NULL);
909 if (tb_vendor[QCA_WLAN_VENDOR_ATTR_SCAN_COOKIE])
910 *cookie = nla_get_u64(
911 tb_vendor[QCA_WLAN_VENDOR_ATTR_SCAN_COOKIE]);
919 * wpa_driver_nl80211_vendor_scan - Request the driver to initiate a vendor scan
920 * @bss: Pointer to private driver data from wpa_driver_nl80211_init()
921 * @params: Scan parameters
922 * Returns: 0 on success, -1 on failure
924 int wpa_driver_nl80211_vendor_scan(struct i802_bss *bss,
925 struct wpa_driver_scan_params *params)
927 struct wpa_driver_nl80211_data *drv = bss->drv;
928 struct nl_msg *msg = NULL;
935 wpa_dbg(drv->ctx, MSG_DEBUG, "nl80211: vendor scan request");
936 drv->scan_for_auth = 0;
938 if (!(msg = nl80211_drv_msg(drv, 0, NL80211_CMD_VENDOR)) ||
939 nla_put_u32(msg, NL80211_ATTR_VENDOR_ID, OUI_QCA) ||
940 nla_put_u32(msg, NL80211_ATTR_VENDOR_SUBCMD,
941 QCA_NL80211_VENDOR_SUBCMD_TRIGGER_SCAN) )
944 attr = nla_nest_start(msg, NL80211_ATTR_VENDOR_DATA);
948 if (params->num_ssids) {
949 struct nlattr *ssids;
951 ssids = nla_nest_start(msg, QCA_WLAN_VENDOR_ATTR_SCAN_SSIDS);
954 for (i = 0; i < params->num_ssids; i++) {
955 wpa_hexdump_ascii(MSG_MSGDUMP, "nl80211: Scan SSID",
956 params->ssids[i].ssid,
957 params->ssids[i].ssid_len);
958 if (nla_put(msg, i + 1, params->ssids[i].ssid_len,
959 params->ssids[i].ssid))
962 nla_nest_end(msg, ssids);
965 if (params->extra_ies) {
966 wpa_hexdump(MSG_MSGDUMP, "nl80211: Scan extra IEs",
967 params->extra_ies, params->extra_ies_len);
968 if (nla_put(msg, QCA_WLAN_VENDOR_ATTR_SCAN_IE,
969 params->extra_ies_len, params->extra_ies))
974 struct nlattr *freqs;
976 freqs = nla_nest_start(msg,
977 QCA_WLAN_VENDOR_ATTR_SCAN_FREQUENCIES);
980 for (i = 0; params->freqs[i]; i++) {
981 wpa_printf(MSG_MSGDUMP,
982 "nl80211: Scan frequency %u MHz",
984 if (nla_put_u32(msg, i + 1, params->freqs[i]))
987 nla_nest_end(msg, freqs);
990 os_free(drv->filter_ssids);
991 drv->filter_ssids = params->filter_ssids;
992 params->filter_ssids = NULL;
993 drv->num_filter_ssids = params->num_filter_ssids;
995 if (params->low_priority && drv->have_low_prio_scan) {
996 wpa_printf(MSG_DEBUG,
997 "nl80211: Add NL80211_SCAN_FLAG_LOW_PRIORITY");
998 scan_flags |= NL80211_SCAN_FLAG_LOW_PRIORITY;
1001 if (params->mac_addr_rand) {
1002 wpa_printf(MSG_DEBUG,
1003 "nl80211: Add NL80211_SCAN_FLAG_RANDOM_ADDR");
1004 scan_flags |= NL80211_SCAN_FLAG_RANDOM_ADDR;
1006 if (params->mac_addr) {
1007 wpa_printf(MSG_DEBUG, "nl80211: MAC address: " MACSTR,
1008 MAC2STR(params->mac_addr));
1009 if (nla_put(msg, QCA_WLAN_VENDOR_ATTR_SCAN_MAC,
1010 ETH_ALEN, params->mac_addr))
1014 if (params->mac_addr_mask) {
1015 wpa_printf(MSG_DEBUG, "nl80211: MAC address mask: "
1016 MACSTR, MAC2STR(params->mac_addr_mask));
1017 if (nla_put(msg, QCA_WLAN_VENDOR_ATTR_SCAN_MAC_MASK,
1018 ETH_ALEN, params->mac_addr_mask))
1024 nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, scan_flags))
1027 if (params->p2p_probe) {
1028 struct nlattr *rates;
1030 wpa_printf(MSG_DEBUG, "nl80211: P2P probe - mask SuppRates");
1032 rates = nla_nest_start(msg,
1033 QCA_WLAN_VENDOR_ATTR_SCAN_SUPP_RATES);
1038 * Remove 2.4 GHz rates 1, 2, 5.5, 11 Mbps from supported rates
1039 * by masking out everything else apart from the OFDM rates 6,
1040 * 9, 12, 18, 24, 36, 48, 54 Mbps from non-MCS rates. All 5 GHz
1041 * rates are left enabled.
1043 if (nla_put(msg, NL80211_BAND_2GHZ, 8,
1044 "\x0c\x12\x18\x24\x30\x48\x60\x6c"))
1046 nla_nest_end(msg, rates);
1048 if (nla_put_flag(msg, QCA_WLAN_VENDOR_ATTR_SCAN_TX_NO_CCK_RATE))
1052 nla_nest_end(msg, attr);
1054 ret = send_and_recv_msgs(drv, msg, scan_cookie_handler, &cookie);
1057 wpa_printf(MSG_DEBUG,
1058 "nl80211: Vendor scan trigger failed: ret=%d (%s)",
1059 ret, strerror(-ret));
1063 drv->vendor_scan_cookie = cookie;
1064 drv->scan_state = SCAN_REQUESTED;
1066 wpa_printf(MSG_DEBUG,
1067 "nl80211: Vendor scan requested (ret=%d) - scan timeout 30 seconds, scan cookie:0x%llx",
1068 ret, (long long unsigned int) cookie);
1069 eloop_cancel_timeout(wpa_driver_nl80211_scan_timeout, drv, drv->ctx);
1070 eloop_register_timeout(30, 0, wpa_driver_nl80211_scan_timeout,
1072 drv->last_scan_cmd = NL80211_CMD_VENDOR;
1079 #endif /* CONFIG_DRIVER_NL80211_QCA */