Kernel/iwd
3
0
Fork 0
mirror of https://git.kernel.org/pub/scm/network/wireless/iwd.git synced 2024-11-17 17:39:28 +01:00
Code Releases Activity

scan: Parse scanned frequencies

Browse Source
This commit is contained in:
Denis Kenzior 2015-06-10 16:24:31 -05:00
parent b70f5a239d
commit 9773405c47
1 changed files with 59 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

65
src/scan.c
View File

@ -53,6 +53,7 @@ struct scan_results {
uint32_t wiphy; uint32_t wiphy;
uint32_t ifindex; uint32_t ifindex;
struct l_queue *bss_list; struct l_queue *bss_list;
struct scan_freq_set *freqs;
}; };
struct scan_periodic { struct scan_periodic {
@ -319,6 +320,28 @@ fail:
return NULL; return NULL;
} }
static struct scan_freq_set *scan_parse_attr_scan_frequencies(
struct l_genl_attr *attr)
{
uint16_t type, len;
const void *data;
struct scan_freq_set *set;
set = scan_freq_set_new();
while (l_genl_attr_next(attr, &type, &len, &data)) {
uint32_t freq;
if (len != sizeof(uint32_t))
continue;
freq = *((uint32_t *) data);
scan_freq_set_add(set, freq);
}
return set;
}
static struct scan_bss *scan_parse_result(struct l_genl_msg *msg, static struct scan_bss *scan_parse_result(struct l_genl_msg *msg,
uint32_t *out_ifindex, uint32_t *out_ifindex,
uint64_t *out_wdev) uint64_t *out_wdev)
@ -524,9 +547,37 @@ static void get_scan_done(void *user)
(l_queue_destroy_func_t) scan_bss_free); (l_queue_destroy_func_t) scan_bss_free);
done: done:
if (results->freqs)
scan_freq_set_free(results->freqs);
l_free(results); l_free(results);
} }
static void scan_parse_new_scan_results(struct l_genl_msg *msg,
struct scan_results *results)
{
struct l_genl_attr attr, nested;
uint16_t type, len;
const void *data;
if (!l_genl_attr_init(&attr, msg))
return;
while (l_genl_attr_next(&attr, &type, &len, &data)) {
switch (type) {
case NL80211_ATTR_SCAN_FREQUENCIES:
if (!l_genl_attr_recurse(&attr, &nested)) {
l_warn("Failed to parse ATTR_SCAN_FREQUENCIES");
break;
}
results->freqs =
scan_parse_attr_scan_frequencies(&nested);
break;
}
}
}
static void scan_notify(struct l_genl_msg *msg, void *user_data) static void scan_notify(struct l_genl_msg *msg, void *user_data)
{ {
struct l_genl_attr attr; struct l_genl_attr attr;
@ -585,7 +636,7 @@ static void scan_notify(struct l_genl_msg *msg, void *user_data)
case NL80211_CMD_NEW_SCAN_RESULTS: case NL80211_CMD_NEW_SCAN_RESULTS:
case NL80211_CMD_SCHED_SCAN_RESULTS: case NL80211_CMD_SCHED_SCAN_RESULTS:
{ {
struct l_genl_msg *msg; struct l_genl_msg *scan_msg;
struct scan_results *results; struct scan_results *results;
struct scan_periodic *sp; struct scan_periodic *sp;
@ -593,11 +644,13 @@ static void scan_notify(struct l_genl_msg *msg, void *user_data)
results->wiphy = attr_wiphy; results->wiphy = attr_wiphy;
results->ifindex = attr_ifindex; results->ifindex = attr_ifindex;
msg = l_genl_msg_new_sized(NL80211_CMD_GET_SCAN, 8); scan_parse_new_scan_results(msg, results);
l_genl_msg_append_attr(msg, NL80211_ATTR_IFINDEX, 4,
scan_msg = l_genl_msg_new_sized(NL80211_CMD_GET_SCAN, 8);
l_genl_msg_append_attr(scan_msg, NL80211_ATTR_IFINDEX, 4,
&attr_ifindex); &attr_ifindex);
l_genl_family_dump(nl80211, msg, get_scan_callback, results, l_genl_family_dump(nl80211, scan_msg, get_scan_callback,
get_scan_done); results, get_scan_done);
sp = l_queue_find(periodic_scans, scan_periodic_match, sp = l_queue_find(periodic_scans, scan_periodic_match,
L_UINT_TO_PTR(attr_ifindex)); L_UINT_TO_PTR(attr_ifindex));
@ -681,7 +734,7 @@ struct scan_freq_set *scan_freq_set_new(void)
void scan_freq_set_free(struct scan_freq_set *freqs) void scan_freq_set_free(struct scan_freq_set *freqs)
{ {
l_free(freqs->channels_5ghz); l_uintset_free(freqs->channels_5ghz);
l_free(freqs); l_free(freqs);
} }