From 6d3314ca56989f1d075c9c9594a1ed8a77e6c2f4 Mon Sep 17 00:00:00 2001 From: David Bauer Date: Fri, 1 Apr 2022 00:27:28 +0200 Subject: [PATCH] local-node: handle received link-measurement reports Store link-measurement reports received from STAs as measurements. Signed-off-by: David Bauer --- local_node.c | 39 +++++++++++++++++++++++++++++++++++++++ 1 file changed, 39 insertions(+) diff --git a/local_node.c b/local_node.c index baaa608..bf6ade9 100644 --- a/local_node.c +++ b/local_node.c @@ -236,6 +236,43 @@ usteer_local_node_handle_beacon_report(struct usteer_local_node *ln, struct blob return 0; } +static int +usteer_local_node_handle_link_measurement_report(struct usteer_local_node *ln, struct blob_attr *msg) +{ + enum { + LMR_ADDRESS, + LMR_RCPI, + LMR_RSNI, + __LMR_MAX + }; + struct blobmsg_policy policy[__LMR_MAX] = { + [LMR_ADDRESS] = { .name = "address", .type = BLOBMSG_TYPE_STRING }, + [LMR_RCPI] = { .name = "rcpi", .type = BLOBMSG_TYPE_INT16 }, + [LMR_RSNI] = { .name = "rsni", .type = BLOBMSG_TYPE_INT16 }, + }; + struct blob_attr *tb[__LMR_MAX]; + uint8_t *addr; + struct sta *sta; + + blobmsg_parse(policy, __LMR_MAX, tb, blob_data(msg), blob_len(msg)); + if (!tb[LMR_ADDRESS] || !tb[LMR_RCPI] || !tb[LMR_RSNI]) + return 0; + + addr = (uint8_t *) ether_aton(blobmsg_get_string(tb[LMR_ADDRESS])); + if (!addr) + return 0; + + sta = usteer_sta_get(addr, false); + if (!sta) + return 0; + + usteer_measurement_report_add(sta, &ln->node, + (uint8_t)blobmsg_get_u16(tb[LMR_RCPI]), + (uint8_t)blobmsg_get_u16(tb[LMR_RSNI]), + current_time); + return 0; +} + static int usteer_handle_event(struct ubus_context *ctx, struct ubus_object *obj, struct ubus_request_data *req, const char *method, @@ -275,6 +312,8 @@ usteer_handle_event(struct ubus_context *ctx, struct ubus_object *obj, return usteer_handle_bss_tm_response(ln, msg); } else if(!strcmp(method, "beacon-report")) { return usteer_local_node_handle_beacon_report(ln, msg); + } else if(!strcmp(method, "link-measurement-report")) { + return usteer_local_node_handle_link_measurement_report(ln, msg); } for (i = 0; i < ARRAY_SIZE(event_types); i++) { -- 2.30.2