node: move roam-events to dedicated struct
[project/usteer.git] / ubus.c
1 /*
2 * This program is free software; you can redistribute it and/or modify
3 * it under the terms of the GNU General Public License as published by
4 * the Free Software Foundation; either version 2 of the License.
5 *
6 * This program is distributed in the hope that it will be useful,
7 * but WITHOUT ANY WARRANTY; without even the implied warranty of
8 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
9 * GNU General Public License for more details.
10 *
11 * You should have received a copy of the GNU General Public License
12 * along with this program; if not, write to the Free Software
13 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA.
14 *
15 * Copyright (C) 2020 embedd.ch
16 * Copyright (C) 2020 Felix Fietkau <nbd@nbd.name>
17 * Copyright (C) 2020 John Crispin <john@phrozen.org>
18 */
19
20 #include <sys/types.h>
21 #include <sys/socket.h>
22 #include <net/ethernet.h>
23 #ifdef linux
24 #include <netinet/ether.h>
25 #endif
26
27 #include "usteer.h"
28 #include "node.h"
29 #include "event.h"
30
31 static struct blob_buf b;
32 static KVLIST(host_info, kvlist_blob_len);
33
34 static int
35 usteer_ubus_get_clients(struct ubus_context *ctx, struct ubus_object *obj,
36 struct ubus_request_data *req, const char *method,
37 struct blob_attr *msg)
38 {
39 struct sta_info *si;
40 struct sta *sta;
41 char str[20];
42 void *_s, *_cur_n;
43
44 blob_buf_init(&b, 0);
45 avl_for_each_element(&stations, sta, avl) {
46 sprintf(str, MAC_ADDR_FMT, MAC_ADDR_DATA(sta->addr));
47 _s = blobmsg_open_table(&b, str);
48 list_for_each_entry(si, &sta->nodes, list) {
49 _cur_n = blobmsg_open_table(&b, usteer_node_name(si->node));
50 blobmsg_add_u8(&b, "connected", si->connected);
51 blobmsg_add_u32(&b, "signal", si->signal);
52 blobmsg_close_table(&b, _cur_n);
53 }
54 blobmsg_close_table(&b, _s);
55 }
56 ubus_send_reply(ctx, req, b.head);
57 return 0;
58 }
59
60 static struct blobmsg_policy client_arg[] = {
61 { .name = "address", .type = BLOBMSG_TYPE_STRING, },
62 };
63
64 static void
65 usteer_ubus_add_stats(struct sta_info_stats *stats, const char *name)
66 {
67 void *s;
68
69 s = blobmsg_open_table(&b, name);
70 blobmsg_add_u32(&b, "requests", stats->requests);
71 blobmsg_add_u32(&b, "blocked_cur", stats->blocked_cur);
72 blobmsg_add_u32(&b, "blocked_total", stats->blocked_total);
73 blobmsg_close_table(&b, s);
74 }
75
76 static int
77 usteer_ubus_get_client_info(struct ubus_context *ctx, struct ubus_object *obj,
78 struct ubus_request_data *req, const char *method,
79 struct blob_attr *msg)
80 {
81 struct sta_info *si;
82 struct sta *sta;
83 struct blob_attr *mac_str;
84 uint8_t *mac;
85 void *_n, *_cur_n, *_s;
86 int i;
87
88 blobmsg_parse(client_arg, 1, &mac_str, blob_data(msg), blob_len(msg));
89 if (!mac_str)
90 return UBUS_STATUS_INVALID_ARGUMENT;
91
92 mac = (uint8_t *) ether_aton(blobmsg_data(mac_str));
93 if (!mac)
94 return UBUS_STATUS_INVALID_ARGUMENT;
95
96 sta = usteer_sta_get(mac, false);
97 if (!sta)
98 return UBUS_STATUS_NOT_FOUND;
99
100 blob_buf_init(&b, 0);
101 blobmsg_add_u8(&b, "2ghz", sta->seen_2ghz);
102 blobmsg_add_u8(&b, "5ghz", sta->seen_5ghz);
103 _n = blobmsg_open_table(&b, "nodes");
104 list_for_each_entry(si, &sta->nodes, list) {
105 _cur_n = blobmsg_open_table(&b, usteer_node_name(si->node));
106 blobmsg_add_u8(&b, "connected", si->connected);
107 blobmsg_add_u32(&b, "signal", si->signal);
108 _s = blobmsg_open_table(&b, "stats");
109 for (i = 0; i < __EVENT_TYPE_MAX; i++)
110 usteer_ubus_add_stats(&si->stats[EVENT_TYPE_PROBE], event_types[i]);
111 blobmsg_close_table(&b, _s);
112 blobmsg_close_table(&b, _cur_n);
113 }
114 blobmsg_close_table(&b, _n);
115
116 ubus_send_reply(ctx, req, b.head);
117
118 return 0;
119 }
120
121 enum cfg_type {
122 CFG_BOOL,
123 CFG_I32,
124 CFG_U32,
125 CFG_ARRAY_CB,
126 CFG_STRING_CB,
127 };
128
129 struct cfg_item {
130 enum cfg_type type;
131 union {
132 bool *BOOL;
133 uint32_t *U32;
134 int32_t *I32;
135 struct {
136 void (*set)(struct blob_attr *data);
137 void (*get)(struct blob_buf *buf);
138 } CB;
139 } ptr;
140 };
141
142 #define __config_items \
143 _cfg(BOOL, syslog), \
144 _cfg(U32, debug_level), \
145 _cfg(BOOL, ipv6), \
146 _cfg(U32, sta_block_timeout), \
147 _cfg(U32, local_sta_timeout), \
148 _cfg(U32, local_sta_update), \
149 _cfg(U32, max_neighbor_reports), \
150 _cfg(U32, max_retry_band), \
151 _cfg(U32, seen_policy_timeout), \
152 _cfg(U32, load_balancing_threshold), \
153 _cfg(U32, band_steering_threshold), \
154 _cfg(U32, remote_update_interval), \
155 _cfg(BOOL, assoc_steering), \
156 _cfg(I32, min_connect_snr), \
157 _cfg(I32, min_snr), \
158 _cfg(U32, roam_process_timeout), \
159 _cfg(I32, roam_scan_snr), \
160 _cfg(U32, roam_scan_tries), \
161 _cfg(U32, roam_scan_interval), \
162 _cfg(I32, roam_trigger_snr), \
163 _cfg(U32, roam_trigger_interval), \
164 _cfg(U32, roam_kick_delay), \
165 _cfg(U32, signal_diff_threshold), \
166 _cfg(U32, initial_connect_delay), \
167 _cfg(BOOL, load_kick_enabled), \
168 _cfg(U32, load_kick_threshold), \
169 _cfg(U32, load_kick_delay), \
170 _cfg(U32, load_kick_min_clients), \
171 _cfg(U32, load_kick_reason_code), \
172 _cfg(ARRAY_CB, interfaces), \
173 _cfg(STRING_CB, node_up_script), \
174 _cfg(ARRAY_CB, event_log_types), \
175 _cfg(ARRAY_CB, ssid_list)
176
177 enum cfg_items {
178 #define _cfg(_type, _name) CFG_##_name
179 __config_items,
180 #undef _cfg
181 __CFG_MAX,
182 };
183
184 static const struct blobmsg_policy config_policy[__CFG_MAX] = {
185 #define _cfg_policy(_type, _name) [CFG_##_name] = { .name = #_name, .type = BLOBMSG_TYPE_ ## _type }
186 #define _cfg_policy_BOOL(_name) _cfg_policy(BOOL, _name)
187 #define _cfg_policy_U32(_name) _cfg_policy(INT32, _name)
188 #define _cfg_policy_I32(_name) _cfg_policy(INT32, _name)
189 #define _cfg_policy_ARRAY_CB(_name) _cfg_policy(ARRAY, _name)
190 #define _cfg_policy_STRING_CB(_name) _cfg_policy(STRING, _name)
191 #define _cfg(_type, _name) _cfg_policy_##_type(_name)
192 __config_items,
193 #undef _cfg
194 };
195
196 static const struct cfg_item config_data[__CFG_MAX] = {
197 #define _cfg_data_BOOL(_name) .ptr.BOOL = &config._name
198 #define _cfg_data_U32(_name) .ptr.U32 = &config._name
199 #define _cfg_data_I32(_name) .ptr.I32 = &config._name
200 #define _cfg_data_ARRAY_CB(_name) .ptr.CB = { .set = config_set_##_name, .get = config_get_##_name }
201 #define _cfg_data_STRING_CB(_name) .ptr.CB = { .set = config_set_##_name, .get = config_get_##_name }
202 #define _cfg(_type, _name) [CFG_##_name] = { .type = CFG_##_type, _cfg_data_##_type(_name) }
203 __config_items,
204 #undef _cfg
205 };
206
207 static int
208 usteer_ubus_get_config(struct ubus_context *ctx, struct ubus_object *obj,
209 struct ubus_request_data *req, const char *method,
210 struct blob_attr *msg)
211 {
212 int i;
213
214 blob_buf_init(&b, 0);
215 for (i = 0; i < __CFG_MAX; i++) {
216 switch(config_data[i].type) {
217 case CFG_BOOL:
218 blobmsg_add_u8(&b, config_policy[i].name,
219 *config_data[i].ptr.BOOL);
220 break;
221 case CFG_I32:
222 case CFG_U32:
223 blobmsg_add_u32(&b, config_policy[i].name,
224 *config_data[i].ptr.U32);
225 break;
226 case CFG_ARRAY_CB:
227 case CFG_STRING_CB:
228 config_data[i].ptr.CB.get(&b);
229 break;
230 }
231 }
232 ubus_send_reply(ctx, req, b.head);
233 return 0;
234 }
235
236 static int
237 usteer_ubus_set_config(struct ubus_context *ctx, struct ubus_object *obj,
238 struct ubus_request_data *req, const char *method,
239 struct blob_attr *msg)
240 {
241 struct blob_attr *tb[__CFG_MAX];
242 int i;
243
244 if (!strcmp(method, "set_config"))
245 usteer_init_defaults();
246
247 blobmsg_parse(config_policy, __CFG_MAX, tb, blob_data(msg), blob_len(msg));
248 for (i = 0; i < __CFG_MAX; i++) {
249 switch(config_data[i].type) {
250 case CFG_BOOL:
251 if (!tb[i])
252 continue;
253
254 *config_data[i].ptr.BOOL = blobmsg_get_u8(tb[i]);
255 break;
256 case CFG_I32:
257 case CFG_U32:
258 if (!tb[i])
259 continue;
260
261 *config_data[i].ptr.U32 = blobmsg_get_u32(tb[i]);
262 break;
263 case CFG_ARRAY_CB:
264 case CFG_STRING_CB:
265 config_data[i].ptr.CB.set(tb[i]);
266 break;
267 }
268 }
269
270 usteer_interface_init();
271
272 return 0;
273 }
274
275 void usteer_dump_node(struct blob_buf *buf, struct usteer_node *node)
276 {
277 void *c, *roam_events;
278
279 c = blobmsg_open_table(buf, usteer_node_name(node));
280 blobmsg_printf(buf, "bssid", MAC_ADDR_FMT, MAC_ADDR_DATA(node->bssid));
281 blobmsg_add_u32(buf, "freq", node->freq);
282 blobmsg_add_u32(buf, "n_assoc", node->n_assoc);
283 blobmsg_add_u32(buf, "noise", node->noise);
284 blobmsg_add_u32(buf, "load", node->load);
285 blobmsg_add_u32(buf, "max_assoc", node->max_assoc);
286
287 roam_events = blobmsg_open_table(buf, "roam_events");
288 blobmsg_add_u32(buf, "source", node->roam_events.source);
289 blobmsg_add_u32(buf, "target", node->roam_events.target);
290 blobmsg_close_table(buf, roam_events);
291
292 if (node->rrm_nr)
293 blobmsg_add_field(buf, BLOBMSG_TYPE_ARRAY, "rrm_nr",
294 blobmsg_data(node->rrm_nr),
295 blobmsg_data_len(node->rrm_nr));
296 if (node->node_info)
297 blobmsg_add_field(buf, BLOBMSG_TYPE_TABLE, "node_info",
298 blob_data(node->node_info),
299 blob_len(node->node_info));
300
301 blobmsg_close_table(buf, c);
302 }
303
304 void usteer_dump_host(struct blob_buf *buf, struct usteer_remote_host *host)
305 {
306 void *c;
307
308 c = blobmsg_open_table(buf, host->addr);
309 blobmsg_add_u32(buf, "id", (uint32_t)(uintptr_t)host->avl.key);
310 if (host->host_info)
311 blobmsg_add_field(buf, BLOBMSG_TYPE_TABLE, "host_info",
312 blobmsg_data(host->host_info),
313 blobmsg_len(host->host_info));
314 blobmsg_close_table(buf, c);
315 }
316
317 static int
318 usteer_ubus_local_info(struct ubus_context *ctx, struct ubus_object *obj,
319 struct ubus_request_data *req, const char *method,
320 struct blob_attr *msg)
321 {
322 struct usteer_node *node;
323
324 blob_buf_init(&b, 0);
325
326 for_each_local_node(node)
327 usteer_dump_node(&b, node);
328
329 ubus_send_reply(ctx, req, b.head);
330
331 return 0;
332 }
333
334 static int
335 usteer_ubus_remote_hosts(struct ubus_context *ctx, struct ubus_object *obj,
336 struct ubus_request_data *req, const char *method,
337 struct blob_attr *msg)
338 {
339 struct usteer_remote_host *host;
340
341 blob_buf_init(&b, 0);
342
343 avl_for_each_element(&remote_hosts, host, avl)
344 usteer_dump_host(&b, host);
345
346 ubus_send_reply(ctx, req, b.head);
347
348 return 0;
349 }
350
351 static int
352 usteer_ubus_remote_info(struct ubus_context *ctx, struct ubus_object *obj,
353 struct ubus_request_data *req, const char *method,
354 struct blob_attr *msg)
355 {
356 struct usteer_remote_node *rn;
357
358 blob_buf_init(&b, 0);
359
360 for_each_remote_node(rn)
361 usteer_dump_node(&b, &rn->node);
362
363 ubus_send_reply(ctx, req, b.head);
364
365 return 0;
366 }
367
368 enum {
369 NODE_DATA_NODE,
370 NODE_DATA_VALUES,
371 __NODE_DATA_MAX,
372 };
373
374 static const struct blobmsg_policy set_node_data_policy[] = {
375 [NODE_DATA_NODE] = { "node", BLOBMSG_TYPE_STRING },
376 [NODE_DATA_VALUES] = { "data", BLOBMSG_TYPE_TABLE },
377 };
378
379 static const struct blobmsg_policy del_node_data_policy[] = {
380 [NODE_DATA_NODE] = { "node", BLOBMSG_TYPE_STRING },
381 [NODE_DATA_VALUES] = { "names", BLOBMSG_TYPE_ARRAY },
382 };
383
384 static void
385 usteer_update_kvlist_data(struct kvlist *kv, struct blob_attr *data,
386 bool delete)
387 {
388 struct blob_attr *cur;
389 int rem;
390
391 blobmsg_for_each_attr(cur, data, rem) {
392 if (delete)
393 kvlist_delete(kv, blobmsg_get_string(cur));
394 else
395 kvlist_set(kv, blobmsg_name(cur), cur);
396 }
397 }
398
399 static void
400 usteer_update_kvlist_blob(struct blob_attr **dest, struct kvlist *kv)
401 {
402 struct blob_attr *val;
403 const char *name;
404
405 blob_buf_init(&b, 0);
406 kvlist_for_each(kv, name, val)
407 blobmsg_add_field(&b, blobmsg_type(val), name,
408 blobmsg_data(val), blobmsg_len(val));
409
410 val = b.head;
411 if (!blobmsg_len(val))
412 val = NULL;
413
414 usteer_node_set_blob(dest, val);
415 }
416
417 static int
418 usteer_ubus_update_node_data(struct ubus_context *ctx, struct ubus_object *obj,
419 struct ubus_request_data *req, const char *method,
420 struct blob_attr *msg)
421 {
422 const struct blobmsg_policy *policy;
423 struct blob_attr *tb[__NODE_DATA_MAX];
424 struct usteer_local_node *ln;
425 struct blob_attr *val;
426 const char *name;
427 bool delete;
428
429 delete = !strncmp(method, "del", 3);
430 policy = delete ? del_node_data_policy : set_node_data_policy;
431
432 blobmsg_parse(policy, __NODE_DATA_MAX, tb, blob_data(msg), blob_len(msg));
433 if (!tb[NODE_DATA_NODE] || !tb[NODE_DATA_VALUES])
434 return UBUS_STATUS_INVALID_ARGUMENT;
435
436 name = blobmsg_get_string(tb[NODE_DATA_NODE]);
437 val = tb[NODE_DATA_VALUES];
438 if (delete && blobmsg_check_array(val, BLOBMSG_TYPE_STRING) < 0)
439 return UBUS_STATUS_INVALID_ARGUMENT;
440
441 if (strcmp(name, "*") != 0) {
442 ln = avl_find_element(&local_nodes, name, ln, node.avl);
443 if (!ln)
444 return UBUS_STATUS_NOT_FOUND;
445
446 usteer_update_kvlist_data(&ln->node_info, val, delete);
447 usteer_update_kvlist_blob(&ln->node.node_info, &ln->node_info);
448
449 return 0;
450 }
451
452 usteer_update_kvlist_data(&host_info, val, delete);
453 usteer_update_kvlist_blob(&host_info_blob, &host_info);
454
455 return 0;
456 }
457
458 static const struct ubus_method usteer_methods[] = {
459 UBUS_METHOD_NOARG("local_info", usteer_ubus_local_info),
460 UBUS_METHOD_NOARG("remote_hosts", usteer_ubus_remote_hosts),
461 UBUS_METHOD_NOARG("remote_info", usteer_ubus_remote_info),
462 UBUS_METHOD_NOARG("get_clients", usteer_ubus_get_clients),
463 UBUS_METHOD("get_client_info", usteer_ubus_get_client_info, client_arg),
464 UBUS_METHOD_NOARG("get_config", usteer_ubus_get_config),
465 UBUS_METHOD("set_config", usteer_ubus_set_config, config_policy),
466 UBUS_METHOD("update_config", usteer_ubus_set_config, config_policy),
467 UBUS_METHOD("set_node_data", usteer_ubus_update_node_data, set_node_data_policy),
468 UBUS_METHOD("delete_node_data", usteer_ubus_update_node_data, del_node_data_policy),
469 };
470
471 static struct ubus_object_type usteer_obj_type =
472 UBUS_OBJECT_TYPE("usteer", usteer_methods);
473
474 struct ubus_object usteer_obj = {
475 .name = "usteer",
476 .type = &usteer_obj_type,
477 .methods = usteer_methods,
478 .n_methods = ARRAY_SIZE(usteer_methods),
479 };
480
481 static bool
482 usteer_add_nr_entry(struct usteer_node *ln, struct usteer_node *node)
483 {
484 struct blobmsg_policy policy[3] = {
485 { .type = BLOBMSG_TYPE_STRING },
486 { .type = BLOBMSG_TYPE_STRING },
487 { .type = BLOBMSG_TYPE_STRING },
488 };
489 struct blob_attr *tb[3];
490
491 if (!node->rrm_nr)
492 return false;
493
494 if (strcmp(ln->ssid, node->ssid) != 0)
495 return false;
496
497 blobmsg_parse_array(policy, ARRAY_SIZE(tb), tb,
498 blobmsg_data(node->rrm_nr),
499 blobmsg_data_len(node->rrm_nr));
500 if (!tb[2])
501 return false;
502
503 blobmsg_add_field(&b, BLOBMSG_TYPE_STRING, "",
504 blobmsg_data(tb[2]),
505 blobmsg_data_len(tb[2]));
506
507 return true;
508 }
509
510 static void
511 usteer_ubus_disassoc_add_neighbors(struct sta_info *si)
512 {
513 struct usteer_node *node, *last_remote_neighbor = NULL;
514 int i = 0;
515 void *c;
516
517 c = blobmsg_open_array(&b, "neighbors");
518 for_each_local_node(node) {
519 if (i >= config.max_neighbor_reports)
520 break;
521 if (usteer_add_nr_entry(si->node, node))
522 i++;
523 }
524
525 while (i < config.max_neighbor_reports) {
526 node = usteer_node_get_next_neighbor(si->node, last_remote_neighbor);
527 if (!node) {
528 /* No more nodes available */
529 break;
530 }
531
532 last_remote_neighbor = node;
533 if (usteer_add_nr_entry(si->node, node))
534 i++;
535 }
536 blobmsg_close_array(&b, c);
537 }
538
539 int usteer_ubus_notify_client_disassoc(struct sta_info *si)
540 {
541 struct usteer_local_node *ln = container_of(si->node, struct usteer_local_node, node);
542
543 blob_buf_init(&b, 0);
544 blobmsg_printf(&b, "addr", MAC_ADDR_FMT, MAC_ADDR_DATA(si->sta->addr));
545 blobmsg_add_u32(&b, "duration", config.roam_kick_delay);
546 usteer_ubus_disassoc_add_neighbors(si);
547 return ubus_invoke(ubus_ctx, ln->obj_id, "wnm_disassoc_imminent", b.head, NULL, 0, 100);
548 }
549
550 int usteer_ubus_trigger_client_scan(struct sta_info *si)
551 {
552 struct usteer_local_node *ln = container_of(si->node, struct usteer_local_node, node);
553
554 if (!usteer_sta_supports_beacon_measurement_mode(si->sta, BEACON_MEASUREMENT_ACTIVE)) {
555 MSG(DEBUG, "STA does not support beacon measurement sta=" MAC_ADDR_FMT "\n", MAC_ADDR_DATA(si->sta->addr));
556 return 0;
557 }
558
559 si->scan_band = !si->scan_band;
560
561 blob_buf_init(&b, 0);
562 blobmsg_printf(&b, "addr", MAC_ADDR_FMT, MAC_ADDR_DATA(si->sta->addr));
563 blobmsg_add_u32(&b, "mode", BEACON_MEASUREMENT_ACTIVE);
564 blobmsg_add_u32(&b, "duration", config.roam_scan_interval / 100);
565 blobmsg_add_u32(&b, "channel", 0);
566 blobmsg_add_u32(&b, "op_class", si->scan_band ? 1 : 12);
567 return ubus_invoke(ubus_ctx, ln->obj_id, "rrm_beacon_req", b.head, NULL, 0, 100);
568 }
569
570 void usteer_ubus_kick_client(struct sta_info *si)
571 {
572 struct usteer_local_node *ln = container_of(si->node, struct usteer_local_node, node);
573
574 blob_buf_init(&b, 0);
575 blobmsg_printf(&b, "addr", MAC_ADDR_FMT, MAC_ADDR_DATA(si->sta->addr));
576 blobmsg_add_u32(&b, "reason", config.load_kick_reason_code);
577 blobmsg_add_u8(&b, "deauth", 1);
578 ubus_invoke(ubus_ctx, ln->obj_id, "del_client", b.head, NULL, 0, 100);
579 si->connected = STA_NOT_CONNECTED;
580 si->roam_kick = current_time;
581 }
582
583 void usteer_ubus_init(struct ubus_context *ctx)
584 {
585 ubus_add_object(ctx, &usteer_obj);
586 }