* [PATCH v2 2/3] rrm: add radio resource management module
2019-11-06 17:57 [PATCH v2 1/3] wiphy: add beacon bits to RM Enabled Capabilities James Prestwood
@ 2019-11-06 17:57 ` James Prestwood
2019-11-06 21:34 ` Denis Kenzior
2019-11-06 17:57 ` [PATCH v2 3/3] auto-t: add RRM autotest James Prestwood
1 sibling, 1 reply; 6+ messages in thread
From: James Prestwood @ 2019-11-06 17:57 UTC (permalink / raw)
To: iwd
[-- Attachment #1: Type: text/plain, Size: 24062 bytes --]
This module takes care of radio measurements which an AP can request.
There are many types of requests, and for now only beacon requests
are supported.
IWD will filter certain types of beacon requests that are NOT
supported:
- AP channel reports. Only single channel requests will be supported
- Autonomous measurements. Only direct requests will be supported.
IWD will not accept requets to trigger reports under certain
conditions (SNR/RSSI thresholds, etc.)
- Timed measurements. Only immediate measurements will be performed.
The accuracy for timed measurements cannot be reliably guaranteed
due to kernel scheduling/queues.
- Full reporting detail. The AP can request the STA return the full
set of IEs in a beacon. IWD does not currently save all IEs, plus
there is quite a bit of complexity involved as certain IEs get
truncated, and there are other length limitations.
There are other limitations not specific to beacon requests:
- IWD will support single measurement requests per report. Multiple
measurement request IEs can be included, but the reports will be
sent out separately.
- IWD will limit the number of requests it responds to in a given
amount of time. As it stands now this is hard coded to 2 requests
per second maximum. This will prevent DoS attacks.
- IWD will not accept any measurement requests from APs it is not
connected to, and will not accept any requests until connected.
---
Makefile.am | 1 +
src/rrm.c | 786 ++++++++++++++++++++++++++++++++++++++++++++++++++++
2 files changed, 787 insertions(+)
create mode 100644 src/rrm.c
-v2:
* Added a per-netdev 'rrm_state'. This holds values such as ifindex
wdev_id, connected address etc which will be used for all requests
on a given netdev
* Watch station and disable/enable rrm_state depending on if we get
connected or disconnected.
* Refactored rrm_request_info/rrm_beacon_req_info to avoid extra
allocations (using l_container_of)
* rrm_state also holds 'pending' requests and will ignore any
requests made when we have an outstanding request
* Track scan ID's and cancel if station becomes disconnected
diff --git a/Makefile.am b/Makefile.am
index 9c54cef0..13141848 100644
--- a/Makefile.am
+++ b/Makefile.am
@@ -226,6 +226,7 @@ src_iwd_SOURCES = src/main.c linux/nl80211.h src/iwd.h src/missing.h \
src/hotspot.c \
src/p2putil.h src/p2putil.c \
src/module.c \
+ src/rrm.c \
$(eap_sources) \
$(builtin_sources)
diff --git a/src/rrm.c b/src/rrm.c
new file mode 100644
index 00000000..4041be59
--- /dev/null
+++ b/src/rrm.c
@@ -0,0 +1,786 @@
+/*
+ *
+ * Wireless daemon for Linux
+ *
+ * Copyright (C) 2019 Intel Corporation. All rights reserved.
+ *
+ * This library is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU Lesser General Public
+ * License as published by the Free Software Foundation; either
+ * version 2.1 of the License, or (at your option) any later version.
+ *
+ * This library is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
+ * Lesser General Public License for more details.
+ *
+ * You should have received a copy of the GNU Lesser General Public
+ * License along with this library; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
+ *
+ */
+
+#ifdef HAVE_CONFIG_H
+#include <config.h>
+#endif
+
+#include <stdint.h>
+#include <math.h>
+#include <linux/if_ether.h>
+
+#include <ell/ell.h>
+
+#include "src/mpdu.h"
+#include "src/netdev.h"
+#include "src/iwd.h"
+#include "src/ie.h"
+#include "src/util.h"
+#include "src/station.h"
+#include "src/scan.h"
+#include "src/nl80211util.h"
+
+#include "linux/nl80211.h"
+
+/* Limit requests per second */
+#define MAX_REQUESTS_PER_SEC 2
+/* Microseconds between requests */
+#define MIN_MICROS_BETWEEN_REQUESTS (1000000 / MAX_REQUESTS_PER_SEC)
+
+/* 802.11-2016 Table 9-90 */
+#define REPORT_DETAIL_NO_FIELDS_OR_ELEMS 0
+#define REPORT_DETAIL_ALL_FIELDS_AND_ANY_REQUEST_ELEMS 1
+#define REPORT_DETAIL_ALL_FIELDS_AND_ELEMS 2
+
+/* 802.11-2016 Table 9-192 */
+#define REPORT_REJECT_LATE (1 << 0)
+#define REPORT_REJECT_INCAPABLE (1 << 1)
+#define REPORT_REJECT_REFUSED (1 << 2)
+
+/* 802.11-2016 Table 9-87 */
+enum rrm_beacon_req_mode {
+ RRM_BEACON_REQ_MODE_PASSIVE = 0,
+ RRM_BEACON_REQ_MODE_ACTIVE = 1,
+ RRM_BEACON_REQ_MODE_TABLE = 2,
+};
+
+/* 802.11-2016 Table 9-88 */
+enum rrm_beacon_req_subelem_id {
+ RRM_BEACON_REQ_SUBELEM_ID_SSID = 0,
+ RRM_BEACON_REQ_SUBELEM_ID_BEACON_REPORTING = 1,
+ RRM_BEACON_REQ_SUBELEM_ID_REPORTING_DETAIL = 2,
+ /* 3 - 9 reserved */
+ RRM_BEACON_REQ_SUBELEM_ID_REQUEST = 10,
+ RRM_BEACON_REQ_SUBELEM_ID_EXT_REQUEST = 11,
+ /* 12 - 50 reserved */
+ RRM_BEACON_REQ_SUBELEM_ID_AP_CHAN_REPORT = 51,
+ /* 52 - 162 reserved */
+ RRM_BEACON_REQ_SUBELEM_ID_WIDE_BAND_SWITCH = 163,
+ /* 164 - 220 reserved */
+ RRM_BEACON_REQ_SUBELEM_ID_VENDOR = 221,
+ /* 222 - 255 reserved */
+};
+
+/* 802.11-2016 Annex C - dot11PHYType */
+enum rrm_phy_type {
+ RRM_PHY_TYPE_DSSS = 2,
+ RRM_PHY_TYPE_OFDM = 4,
+ RRM_PHY_TYPE_HRDSSS = 5,
+ RRM_PHY_TYPE_ERP = 6,
+ RRM_PHY_TYPE_HT = 7,
+ RRM_PHY_TYPE_DMG = 8,
+ RRM_PHY_TYPE_VHT = 9,
+ RRM_PHY_TYPE_TVHT = 10,
+};
+
+struct rrm_request_info {
+ uint8_t dialog_token; /* dialog token in Radio Measurement Request */
+ uint8_t mtoken; /* token in measurement request element */
+ uint8_t mode;
+ uint8_t type; /* request type (only beacon supported) */
+};
+
+struct rrm_beacon_req_info {
+ struct rrm_request_info info;
+ uint8_t oper_class;
+ uint8_t channel; /* The single channel provided in request */
+ uint8_t bssid[6]; /* Request filtered by BSSID */
+ char ssid[33]; /* Request filtered by SSID */
+ bool has_ssid;
+ uint32_t scan_id;
+};
+
+/* Per-netdev state */
+struct rrm_state {
+ uint32_t ifindex;
+ uint64_t wdev_id;
+ uint8_t connected_addr[6];
+ uint32_t connected_freq;
+ struct rrm_request_info *pending;
+
+ uint64_t last_request;
+
+ bool enabled : 1;
+};
+
+static struct l_queue *states;
+static struct l_genl_family *nl80211;
+static uint32_t netdev_watch;
+
+static void rrm_info_destroy(void *data)
+{
+ struct rrm_request_info *info = data;
+ /* TODO: once more request types are added, check type */
+ struct rrm_beacon_req_info *beacon = l_container_of(info,
+ struct rrm_beacon_req_info,
+ info);
+
+ l_free(beacon);
+}
+
+static uint8_t rrm_phy_type(struct scan_bss *bss)
+{
+ if (bss->vht_capable)
+ return RRM_PHY_TYPE_VHT;
+
+ if (bss->ht_capable)
+ return RRM_PHY_TYPE_HT;
+
+ /*
+ * Default to 802.11g phy type. You can get quite fancy here determining
+ * the phy type by looking at the frequency and operator class among
+ * other things. Since 802.11a/b are so old, defaulting to 802.11g just
+ * removes a lot of complexity. Above, HT/VHT are easy as all you need
+ * to look for is the presence of the IE.
+ */
+ return RRM_PHY_TYPE_ERP;
+}
+
+static void rrm_send_response_cb(struct l_genl_msg *msg, void *user_data)
+{
+ int err = l_genl_msg_get_error(msg);
+
+ if (err < 0)
+ l_error("Error sending response: %d", err);
+}
+
+static bool rrm_send_response(struct rrm_state *rrm,
+ const uint8_t *frame, size_t len)
+{
+ struct netdev *netdev = netdev_find(rrm->ifindex);
+ const uint8_t *own_addr = netdev_get_address(netdev);
+ struct l_genl_msg *msg;
+ struct iovec iov;
+
+ iov.iov_base = (void *)frame;
+ iov.iov_len = len;
+
+ msg = nl80211_build_cmd_frame(rrm->ifindex, own_addr,
+ rrm->connected_addr,
+ rrm->connected_freq, &iov, 1);
+
+ if (!l_genl_family_send(nl80211, msg, rrm_send_response_cb,
+ NULL, NULL)) {
+ l_genl_msg_unref(msg);
+ l_error("Failed to send report for "MAC,
+ MAC_STR(rrm->connected_addr));
+ return false;
+ }
+
+ return true;
+}
+
+static void rrm_reject_measurement_request(struct rrm_state *rrm,
+ uint8_t mode)
+{
+ struct rrm_request_info *info = rrm->pending;
+ uint8_t frame[8];
+
+ frame[0] = 0x05; /* Category: Radio Measurement */
+ frame[1] = 0x01; /* Action: Radio Measurement Report */
+ frame[2] = info->dialog_token;
+ frame[3] = IE_TYPE_MEASUREMENT_REQUEST;
+ frame[4] = 3;
+ frame[5] = info->mtoken;
+ frame[6] = mode;
+ frame[7] = info->type;
+
+ if (!rrm_send_response(rrm, frame, sizeof(frame)))
+ l_error("failed to send rejection");
+
+ rrm_info_destroy(info);
+}
+
+static void rrm_build_measurement_report(struct rrm_request_info *info,
+ const void *report, size_t report_len,
+ uint8_t *to)
+{
+ *to++ = IE_TYPE_MEASUREMENT_REPORT;
+ *to++ = 3 + report_len;
+ *to++ = info->mtoken;
+ *to++ = 0;
+ *to++ = info->type;
+
+ if (report)
+ memcpy(to, report, report_len);
+}
+
+/*
+ * 802.11-2016 11.11.9.1 Beacon report
+ *
+ * "If the stored beacon information is based on a measurement made by
+ * the reporting STA, and if the actual measurement start time,
+ * measurement duration, and Parent TSF are available for this
+ * measurement, then the beacon report shall include the actual
+ * measurement start time, measurement duration, and Parent TSF;
+ * otherwise the actual measurement start time, measurement duration,
+ * and Parent TSF shall be set to 0. The RCPI and RSNI for that stored
+ * beacon measurement may be included in the beacon report; otherwise
+ * the beacon report shall indicate that RCPI and RSNI measurements
+ * are not available"
+ *
+ * Since accurate timing is unreliable we are setting start/duration/TSF time to
+ * zero for all cases (table, passive, active).
+ */
+static size_t build_report_for_bss(struct rrm_beacon_req_info *beacon,
+ struct scan_bss *bss,
+ uint8_t *to)
+{
+ uint8_t *start = to;
+ double dbms = bss->signal_strength / 100;
+
+ *to++ = beacon->oper_class;
+ *to++ = scan_freq_to_channel(bss->frequency, NULL);
+ /* skip start time/duration */
+ memset(to, 0, 10);
+ to += 10;
+ *to++ = rrm_phy_type(bss);
+
+ /* 802.11 Table 9-154 - RCPI values */
+ if (dbms < -109.5)
+ *to++ = 0;
+ else if (dbms >= -109.5 && dbms < 0)
+ *to++ = (uint8_t)floor(2 * (dbms + 110));
+ else
+ *to++ = 220;
+
+ /* RSNI not available (could get this from GET_SURVEY) */
+ *to++ = 255;
+ memcpy(to, bss->addr, 6);
+ to += 6;
+ /* Antenna identifier unknown */
+ *to++ = 0;
+ /* Parent TSF - zero */
+ memset(to, 0, 4);
+ to += 4;
+
+ /*
+ * TODO: Support optional subelements
+ *
+ * (see "TODO: Support Reported Frame Body..." below)
+ */
+
+ return to - start;
+}
+
+static bool bss_in_request_range(struct rrm_beacon_req_info *beacon,
+ struct scan_bss *bss)
+{
+ uint8_t channel = scan_freq_to_channel(bss->frequency, NULL);
+
+ /* Must be a table measurement */
+ if (beacon->channel == 0 || beacon->channel == 255)
+ return true;
+
+ if (beacon->channel == channel)
+ return true;
+
+ return false;
+}
+
+static bool rrm_report_beacon_results(struct rrm_state *rrm,
+ struct l_queue *bss_list)
+{
+ struct rrm_beacon_req_info *beacon = l_container_of(rrm->pending,
+ struct rrm_beacon_req_info,
+ info);
+ bool wildcard = util_is_broadcast_address(beacon->bssid);
+ const struct l_queue_entry *entry;
+ uint8_t frame[512];
+ uint8_t *ptr = frame;
+
+ *ptr++ = 0x05; /* Category: Radio Measurement */
+ *ptr++ = 0x01; /* Action: Radio Measurement Report */
+ *ptr++ = beacon->info.dialog_token;
+
+ for (entry = l_queue_get_entries(bss_list); entry;
+ entry = entry->next) {
+ struct scan_bss *bss = entry->data;
+ uint8_t report[257];
+ size_t report_len;
+
+ /* If request included a specific BSSID match only this BSS */
+ if (!wildcard && memcmp(bss->addr, beacon->bssid, 6) != 0)
+ continue;
+
+ /* If request was for a certain SSID, match only this SSID */
+ if (beacon->has_ssid && strncmp(beacon->ssid,
+ (const char *)bss->ssid,
+ sizeof(bss->ssid)) != 0)
+ continue;
+
+ /*
+ * The kernel may have returned a cached scan, so we have to
+ * sort out any non-matching frequencies before building the
+ * report
+ */
+ if (!bss_in_request_range(beacon, bss))
+ continue;
+
+ report_len = build_report_for_bss(beacon, bss, report);
+
+ rrm_build_measurement_report(&beacon->info, report,
+ report_len, ptr);
+
+ ptr += report_len + 5;
+ }
+
+ return rrm_send_response(rrm, frame, ptr - frame);
+}
+
+static void rrm_handle_beacon_table(struct rrm_state *rrm,
+ struct rrm_beacon_req_info *beacon)
+{
+ struct station *station = station_find(rrm->ifindex);
+ struct l_queue *bss_list;
+
+ bss_list = station_get_bss_list(station);
+ if (!bss_list) {
+ rrm_reject_measurement_request(rrm, REPORT_REJECT_INCAPABLE);
+ return;
+ }
+
+ if (!rrm_report_beacon_results(rrm, bss_list))
+ l_error("Error reporting beacon table results");
+
+ /*
+ * Table measurements do not require any async operations so info is
+ * freed here always.
+ */
+ rrm_info_destroy(&beacon->info);
+ rrm->pending = NULL;
+
+}
+
+static bool rrm_scan_results(int err, struct l_queue *bss_list, void *userdata)
+{
+ struct rrm_state *rrm = userdata;
+
+ l_debug("RRM scan results for %u APs", l_queue_length(bss_list));
+
+ rrm_report_beacon_results(rrm, bss_list);
+ /* We aren't saving this BSS list */
+ return false;
+}
+
+static void rrm_scan_triggered(int err, void *userdata)
+{
+ struct rrm_state *rrm = userdata;
+
+ if (err < 0) {
+ l_error("Could not start RRM scan");
+ rrm_reject_measurement_request(rrm, REPORT_REJECT_INCAPABLE);
+ }
+}
+
+static void rrm_scan_destroy(void *data)
+{
+ struct rrm_state *rrm = data;
+
+ rrm_info_destroy(rrm->pending);
+ rrm->pending = NULL;
+}
+
+static void rrm_handle_beacon_scan(struct rrm_state *rrm,
+ struct rrm_beacon_req_info *beacon,
+ bool passive)
+{
+ struct scan_freq_set *freqs = scan_freq_set_new();
+ struct scan_parameters params = { .freqs = freqs, .flush = true };
+ enum scan_band band = scan_oper_class_to_band(NULL, beacon->oper_class);
+ uint32_t freq;
+
+ freq = scan_channel_to_freq(beacon->channel, band);
+ scan_freq_set_add(freqs, freq);
+
+ if (passive)
+ beacon->scan_id = scan_passive(rrm->wdev_id, freqs,
+ rrm_scan_triggered,
+ rrm_scan_results, rrm,
+ rrm_scan_destroy);
+ else
+ beacon->scan_id = scan_active_full(rrm->wdev_id, ¶ms,
+ rrm_scan_triggered,
+ rrm_scan_results, rrm,
+ rrm_scan_destroy);
+
+ scan_freq_set_free(freqs);
+
+ if (beacon->scan_id == 0)
+ rrm_info_destroy(&beacon->info);
+}
+
+static bool rrm_verify_beacon_request(const uint8_t *request, size_t len)
+{
+ if (len < 13)
+ return false;
+
+ if (request[6] != RRM_BEACON_REQ_MODE_TABLE) {
+ /*
+ * Rejecting any iterative measurements, only accepting explicit
+ * channels and operating classes except for table measurements.
+ */
+ if (request[0] == 0 || request[0] == 255 ||
+ request[1] == 0 || request[1] == 255)
+ return false;
+
+ /*
+ * Not handling interval/duration requests. We can omit this
+ * check for table requests since we just return whatever we
+ * have cached.
+ */
+ if (!util_mem_is_zero(request + 2, 4))
+ return false;
+ }
+
+ /* Check this is a valid operating class */
+ if (!scan_oper_class_to_band(NULL, request[0]))
+ return false;
+
+ return true;
+}
+
+static void rrm_handle_beacon_request(struct rrm_state *rrm,
+ uint8_t dialog_token,
+ const uint8_t *request, size_t len)
+{
+ struct rrm_beacon_req_info *beacon;
+ struct ie_tlv_iter iter;
+ /*
+ * 802.11-2016 - Table 9-90
+ *
+ * "All fixed-length fields and elements (default, used when Reporting
+ * Detail subelement is not included in a Beacon request)"
+ */
+ uint8_t detail = REPORT_DETAIL_NO_FIELDS_OR_ELEMS;
+
+ beacon = l_new(struct rrm_beacon_req_info, 1);
+
+ beacon->info.dialog_token = dialog_token;
+ beacon->info.mtoken = request[0];
+ beacon->info.mode = request[1];
+ beacon->info.type = request[2];
+
+ rrm->pending = &beacon->info;
+ /*
+ * 802.11-2016 11.11.8
+ *
+ * "A STA may also refuse to enable triggered autonomous
+ * reporting. In this case a Measurement Report element shall be
+ * returned to the requesting STA with the refused bit set to 1"
+ *
+ * At least for the time being, we will not support autonomous
+ * reporting, so decline any request to do so.
+ */
+ if (util_is_bit_set(beacon->info.mode, 1))
+ goto reject_refused;
+
+ /* advance to beacon request */
+ request += 3;
+ len -= 3;
+
+ if (!rrm_verify_beacon_request(request, len))
+ goto reject_refused;
+
+ beacon->oper_class = request[0];
+ beacon->channel = request[1];
+ memcpy(beacon->bssid, request + 7, 6);
+
+ ie_tlv_iter_init(&iter, request + 13, len - 13);
+
+ while (ie_tlv_iter_next(&iter)) {
+ uint8_t length = ie_tlv_iter_get_length(&iter);
+ const unsigned char *data = ie_tlv_iter_get_data(&iter);
+
+ switch (ie_tlv_iter_get_tag(&iter)) {
+ case RRM_BEACON_REQ_SUBELEM_ID_SSID:
+ /*
+ * Zero length is wildcard SSID, which has the same
+ * effect as no SSID.
+ */
+ if (length > 0 && length < 32) {
+ memcpy(beacon->ssid, data, length);
+ beacon->has_ssid = true;
+ }
+
+ break;
+ case RRM_BEACON_REQ_SUBELEM_ID_REPORTING_DETAIL:
+ if (length != 1) {
+ l_error("Invalid length in reporting detail");
+ goto reject_refused;
+ }
+
+ detail = l_get_u8(data);
+ break;
+ case RRM_BEACON_REQ_SUBELEM_ID_BEACON_REPORTING:
+ /*
+ * 802.11-2016 9.4.2.21.7
+ *
+ * "The Beacon reporting subelement is optionally
+ * present in a Beacon request for repeated
+ * measurements; otherwise it is not present"
+ *
+ * Since repeated measurements are not supported we can
+ * reject this request now.
+ */
+ case RRM_BEACON_REQ_SUBELEM_ID_AP_CHAN_REPORT:
+ /*
+ * Only supporting single channel requests
+ */
+ goto reject_incapable;
+ }
+ }
+
+ /*
+ * TODO: Support Reported Frame Body of 1 and 2. This requires that all
+ * fixed length fields are available from the scan request. Currently
+ * scan.c parses out only the details we care about. There is also
+ * limitations on length, and some IEs are treated specially and
+ * truncated. This adds quite a bit of complexity. For now skip these
+ * types of frame body reports.
+ */
+ if (detail != REPORT_DETAIL_NO_FIELDS_OR_ELEMS) {
+ l_debug("Unsupported report detail");
+ goto reject_incapable;
+ }
+
+ /* Mode */
+ switch (request[6]) {
+ case RRM_BEACON_REQ_MODE_PASSIVE:
+ rrm_handle_beacon_scan(rrm, beacon, true);
+ return;
+ case RRM_BEACON_REQ_MODE_ACTIVE:
+ rrm_handle_beacon_scan(rrm, beacon, false);
+ return;
+ case RRM_BEACON_REQ_MODE_TABLE:
+ rrm_handle_beacon_table(rrm, beacon);
+ return;
+ default:
+ l_error("Unknown beacon mode %u", request[6]);
+ /* fall through to refused */
+ }
+
+reject_refused:
+ rrm_reject_measurement_request(rrm, REPORT_REJECT_REFUSED);
+ return;
+
+reject_incapable:
+ rrm_reject_measurement_request(rrm, REPORT_REJECT_INCAPABLE);
+}
+
+static void rrm_frame_watch_cb(struct netdev *netdev,
+ const struct mmpdu_header *mpdu,
+ const void *body, size_t body_len,
+ void *user_data)
+{
+ struct rrm_state *rrm = user_data;
+ const uint8_t *request = body;
+ uint8_t dialog_token;
+ struct ie_tlv_iter iter;
+
+ /*
+ * Ignore if not connected or already have an outstanding request
+ */
+ if (!rrm->enabled || rrm->pending)
+ return;
+
+ if (memcmp(rrm->connected_addr, mpdu->address_2, 6))
+ return;
+
+ if (body_len < 5)
+ return;
+
+ if (request[0] != 0x05)
+ return;
+
+ if (request[1] != 0x00)
+ return;
+
+ /*
+ * We have reached our max requests per second, no point in continuing
+ */
+ if (l_time_now() - rrm->last_request < MIN_MICROS_BETWEEN_REQUESTS) {
+ l_debug("Max requests per second reached, ignoring request");
+ return;
+ }
+
+ dialog_token = request[2];
+
+ /* Update time regardless of success */
+ rrm->last_request = l_time_now();
+
+ ie_tlv_iter_init(&iter, request + 5, body_len - 5);
+
+ while (ie_tlv_iter_next(&iter)) {
+ const uint8_t *req;
+ size_t req_len;
+
+ if (ie_tlv_iter_get_tag(&iter) != IE_TYPE_MEASUREMENT_REQUEST)
+ continue;
+
+ req = ie_tlv_iter_get_data(&iter);
+ req_len = ie_tlv_iter_get_length(&iter);
+
+ if (req_len < 3)
+ return;
+
+ switch (req[2]) {
+ case 5: /* beacon */
+ rrm_handle_beacon_request(rrm, dialog_token, req,
+ req_len);
+ break;
+ default:
+ return;
+ }
+ }
+}
+
+static void rrm_cancel_pending(struct rrm_state *rrm)
+{
+ if (rrm->pending) {
+ struct rrm_beacon_req_info *beacon;
+
+ beacon = l_container_of(rrm->pending,
+ struct rrm_beacon_req_info,
+ info);
+ if (beacon->scan_id)
+ scan_cancel(rrm->wdev_id, beacon->scan_id);
+
+ rrm_info_destroy(rrm->pending);
+ rrm->pending = NULL;
+ }
+}
+
+static void rrm_station_watch_cb(enum station_state state, void *userdata)
+{
+ struct rrm_state *rrm = userdata;
+ struct station *station;
+ struct scan_bss *bss;
+
+ switch (state) {
+ case STATION_STATE_CONNECTED:
+ station = station_find(rrm->ifindex);
+ bss = station_get_connected_bss(station);
+
+ rrm->enabled = true;
+ memcpy(rrm->connected_addr, bss->addr, 6);
+ rrm->connected_freq = bss->frequency;
+
+ break;
+ case STATION_STATE_DISCONNECTED:
+ rrm->enabled = false;
+
+ rrm_cancel_pending(rrm);
+ break;
+ default:
+ return;
+ }
+}
+
+static void rrm_state_destroy(void *data)
+{
+ struct rrm_state *rrm = data;
+
+ if (rrm->pending)
+ rrm_info_destroy(rrm->pending);
+
+ l_free(rrm);
+}
+
+static void rrm_new_state(struct netdev *netdev)
+{
+ struct rrm_state *rrm;
+ uint16_t frame_type = 0x00d0;
+ uint8_t prefix[] = { 0x05, 0x00 };
+ struct station *station;
+
+ rrm = l_new(struct rrm_state, 1);
+
+ rrm->last_request = l_time_now();
+ rrm->ifindex = netdev_get_ifindex(netdev);
+ rrm->wdev_id = netdev_get_wdev_id(netdev);
+
+ netdev_frame_watch_add(netdev, frame_type, prefix, sizeof(prefix),
+ rrm_frame_watch_cb, rrm);
+
+ station = station_find(rrm->ifindex);
+ station_add_state_watch(station, rrm_station_watch_cb, rrm, NULL);
+
+ l_queue_push_head(states, rrm);
+}
+
+static bool match_ifindex(const void *a, const void *b)
+{
+ const struct rrm_state *rrm = a;
+ uint32_t ifindex = L_PTR_TO_UINT(b);
+
+ return rrm->ifindex == ifindex;
+}
+
+static void rrm_netdev_watch(struct netdev *netdev,
+ enum netdev_watch_event event, void *user_data)
+{
+ struct rrm_state *rrm;
+ uint32_t ifindex = netdev_get_ifindex(netdev);
+
+ switch (event) {
+ case NETDEV_WATCH_EVENT_NEW:
+ rrm_new_state(netdev);
+ return;
+ case NETDEV_WATCH_EVENT_DEL:
+ rrm = l_queue_find(states, match_ifindex,
+ L_UINT_TO_PTR(ifindex));
+ if (!rrm)
+ return;
+
+ rrm_cancel_pending(rrm);
+ return;
+ default:
+ break;
+ }
+}
+
+static int rrm_init(void)
+{
+ struct l_genl *genl = iwd_get_genl();
+
+ states = l_queue_new();
+
+ nl80211 = l_genl_family_new(genl, NL80211_GENL_NAME);
+
+ netdev_watch = netdev_watch_add(rrm_netdev_watch, NULL, NULL);
+
+ return 0;
+}
+
+static void rrm_exit(void)
+{
+ l_genl_family_free(nl80211);
+ nl80211 = NULL;
+
+ netdev_watch_remove(netdev_watch);
+
+ l_queue_destroy(states, rrm_state_destroy);
+}
+
+IWD_MODULE(rrm, rrm_init, rrm_exit);
+IWD_MODULE_DEPENDS(rrm, netdev);
--
2.17.1
^ permalink raw reply related [flat|nested] 6+ messages in thread