policy: add roam-scan timeout
[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(U32, remote_node_timeout), \
156 _cfg(BOOL, assoc_steering), \
157 _cfg(I32, min_connect_snr), \
158 _cfg(I32, min_snr), \
159 _cfg(U32, roam_process_timeout), \
160 _cfg(I32, roam_scan_snr), \
161 _cfg(U32, roam_scan_tries), \
162 _cfg(U32, roam_scan_timeout), \
163 _cfg(U32, roam_scan_interval), \
164 _cfg(I32, roam_trigger_snr), \
165 _cfg(U32, roam_trigger_interval), \
166 _cfg(U32, roam_kick_delay), \
167 _cfg(U32, signal_diff_threshold), \
168 _cfg(U32, initial_connect_delay), \
169 _cfg(BOOL, load_kick_enabled), \
170 _cfg(U32, load_kick_threshold), \
171 _cfg(U32, load_kick_delay), \
172 _cfg(U32, load_kick_min_clients), \
173 _cfg(U32, load_kick_reason_code), \
174 _cfg(ARRAY_CB, interfaces), \
175 _cfg(STRING_CB, node_up_script), \
176 _cfg(ARRAY_CB, event_log_types), \
177 _cfg(ARRAY_CB, ssid_list)
178
179 enum cfg_items {
180 #define _cfg(_type, _name) CFG_##_name
181 __config_items,
182 #undef _cfg
183 __CFG_MAX,
184 };
185
186 static const struct blobmsg_policy config_policy[__CFG_MAX] = {
187 #define _cfg_policy(_type, _name) [CFG_##_name] = { .name = #_name, .type = BLOBMSG_TYPE_ ## _type }
188 #define _cfg_policy_BOOL(_name) _cfg_policy(BOOL, _name)
189 #define _cfg_policy_U32(_name) _cfg_policy(INT32, _name)
190 #define _cfg_policy_I32(_name) _cfg_policy(INT32, _name)
191 #define _cfg_policy_ARRAY_CB(_name) _cfg_policy(ARRAY, _name)
192 #define _cfg_policy_STRING_CB(_name) _cfg_policy(STRING, _name)
193 #define _cfg(_type, _name) _cfg_policy_##_type(_name)
194 __config_items,
195 #undef _cfg
196 };
197
198 static const struct cfg_item config_data[__CFG_MAX] = {
199 #define _cfg_data_BOOL(_name) .ptr.BOOL = &config._name
200 #define _cfg_data_U32(_name) .ptr.U32 = &config._name
201 #define _cfg_data_I32(_name) .ptr.I32 = &config._name
202 #define _cfg_data_ARRAY_CB(_name) .ptr.CB = { .set = config_set_##_name, .get = config_get_##_name }
203 #define _cfg_data_STRING_CB(_name) .ptr.CB = { .set = config_set_##_name, .get = config_get_##_name }
204 #define _cfg(_type, _name) [CFG_##_name] = { .type = CFG_##_type, _cfg_data_##_type(_name) }
205 __config_items,
206 #undef _cfg
207 };
208
209 static int
210 usteer_ubus_get_config(struct ubus_context *ctx, struct ubus_object *obj,
211 struct ubus_request_data *req, const char *method,
212 struct blob_attr *msg)
213 {
214 int i;
215
216 blob_buf_init(&b, 0);
217 for (i = 0; i < __CFG_MAX; i++) {
218 switch(config_data[i].type) {
219 case CFG_BOOL:
220 blobmsg_add_u8(&b, config_policy[i].name,
221 *config_data[i].ptr.BOOL);
222 break;
223 case CFG_I32:
224 case CFG_U32:
225 blobmsg_add_u32(&b, config_policy[i].name,
226 *config_data[i].ptr.U32);
227 break;
228 case CFG_ARRAY_CB:
229 case CFG_STRING_CB:
230 config_data[i].ptr.CB.get(&b);
231 break;
232 }
233 }
234 ubus_send_reply(ctx, req, b.head);
235 return 0;
236 }
237
238 static int
239 usteer_ubus_set_config(struct ubus_context *ctx, struct ubus_object *obj,
240 struct ubus_request_data *req, const char *method,
241 struct blob_attr *msg)
242 {
243 struct blob_attr *tb[__CFG_MAX];
244 int i;
245
246 if (!strcmp(method, "set_config"))
247 usteer_init_defaults();
248
249 blobmsg_parse(config_policy, __CFG_MAX, tb, blob_data(msg), blob_len(msg));
250 for (i = 0; i < __CFG_MAX; i++) {
251 switch(config_data[i].type) {
252 case CFG_BOOL:
253 if (!tb[i])
254 continue;
255
256 *config_data[i].ptr.BOOL = blobmsg_get_u8(tb[i]);
257 break;
258 case CFG_I32:
259 case CFG_U32:
260 if (!tb[i])
261 continue;
262
263 *config_data[i].ptr.U32 = blobmsg_get_u32(tb[i]);
264 break;
265 case CFG_ARRAY_CB:
266 case CFG_STRING_CB:
267 config_data[i].ptr.CB.set(tb[i]);
268 break;
269 }
270 }
271
272 usteer_interface_init();
273
274 return 0;
275 }
276
277 void usteer_dump_node(struct blob_buf *buf, struct usteer_node *node)
278 {
279 void *c, *roam_events;
280
281 c = blobmsg_open_table(buf, usteer_node_name(node));
282 blobmsg_printf(buf, "bssid", MAC_ADDR_FMT, MAC_ADDR_DATA(node->bssid));
283 blobmsg_add_u32(buf, "freq", node->freq);
284 blobmsg_add_u32(buf, "n_assoc", node->n_assoc);
285 blobmsg_add_u32(buf, "noise", node->noise);
286 blobmsg_add_u32(buf, "load", node->load);
287 blobmsg_add_u32(buf, "max_assoc", node->max_assoc);
288
289 roam_events = blobmsg_open_table(buf, "roam_events");
290 blobmsg_add_u32(buf, "source", node->roam_events.source);
291 blobmsg_add_u32(buf, "target", node->roam_events.target);
292 blobmsg_close_table(buf, roam_events);
293
294 if (node->rrm_nr)
295 blobmsg_add_field(buf, BLOBMSG_TYPE_ARRAY, "rrm_nr",
296 blobmsg_data(node->rrm_nr),
297 blobmsg_data_len(node->rrm_nr));
298 if (node->node_info)
299 blobmsg_add_field(buf, BLOBMSG_TYPE_TABLE, "node_info",
300 blob_data(node->node_info),
301 blob_len(node->node_info));
302
303 blobmsg_close_table(buf, c);
304 }
305
306 void usteer_dump_host(struct blob_buf *buf, struct usteer_remote_host *host)
307 {
308 void *c;
309
310 c = blobmsg_open_table(buf, host->addr);
311 blobmsg_add_u32(buf, "id", (uint32_t)(uintptr_t)host->avl.key);
312 if (host->host_info)
313 blobmsg_add_field(buf, BLOBMSG_TYPE_TABLE, "host_info",
314 blobmsg_data(host->host_info),
315 blobmsg_len(host->host_info));
316 blobmsg_close_table(buf, c);
317 }
318
319 static int
320 usteer_ubus_local_info(struct ubus_context *ctx, struct ubus_object *obj,
321 struct ubus_request_data *req, const char *method,
322 struct blob_attr *msg)
323 {
324 struct usteer_node *node;
325
326 blob_buf_init(&b, 0);
327
328 for_each_local_node(node)
329 usteer_dump_node(&b, node);
330
331 ubus_send_reply(ctx, req, b.head);
332
333 return 0;
334 }
335
336 static int
337 usteer_ubus_remote_hosts(struct ubus_context *ctx, struct ubus_object *obj,
338 struct ubus_request_data *req, const char *method,
339 struct blob_attr *msg)
340 {
341 struct usteer_remote_host *host;
342
343 blob_buf_init(&b, 0);
344
345 avl_for_each_element(&remote_hosts, host, avl)
346 usteer_dump_host(&b, host);
347
348 ubus_send_reply(ctx, req, b.head);
349
350 return 0;
351 }
352
353 static int
354 usteer_ubus_remote_info(struct ubus_context *ctx, struct ubus_object *obj,
355 struct ubus_request_data *req, const char *method,
356 struct blob_attr *msg)
357 {
358 struct usteer_remote_node *rn;
359
360 blob_buf_init(&b, 0);
361
362 for_each_remote_node(rn)
363 usteer_dump_node(&b, &rn->node);
364
365 ubus_send_reply(ctx, req, b.head);
366
367 return 0;
368 }
369
370 enum {
371 NODE_DATA_NODE,
372 NODE_DATA_VALUES,
373 __NODE_DATA_MAX,
374 };
375
376 static const struct blobmsg_policy set_node_data_policy[] = {
377 [NODE_DATA_NODE] = { "node", BLOBMSG_TYPE_STRING },
378 [NODE_DATA_VALUES] = { "data", BLOBMSG_TYPE_TABLE },
379 };
380
381 static const struct blobmsg_policy del_node_data_policy[] = {
382 [NODE_DATA_NODE] = { "node", BLOBMSG_TYPE_STRING },
383 [NODE_DATA_VALUES] = { "names", BLOBMSG_TYPE_ARRAY },
384 };
385
386 static void
387 usteer_update_kvlist_data(struct kvlist *kv, struct blob_attr *data,
388 bool delete)
389 {
390 struct blob_attr *cur;
391 int rem;
392
393 blobmsg_for_each_attr(cur, data, rem) {
394 if (delete)
395 kvlist_delete(kv, blobmsg_get_string(cur));
396 else
397 kvlist_set(kv, blobmsg_name(cur), cur);
398 }
399 }
400
401 static void
402 usteer_update_kvlist_blob(struct blob_attr **dest, struct kvlist *kv)
403 {
404 struct blob_attr *val;
405 const char *name;
406
407 blob_buf_init(&b, 0);
408 kvlist_for_each(kv, name, val)
409 blobmsg_add_field(&b, blobmsg_type(val), name,
410 blobmsg_data(val), blobmsg_len(val));
411
412 val = b.head;
413 if (!blobmsg_len(val))
414 val = NULL;
415
416 usteer_node_set_blob(dest, val);
417 }
418
419 static int
420 usteer_ubus_update_node_data(struct ubus_context *ctx, struct ubus_object *obj,
421 struct ubus_request_data *req, const char *method,
422 struct blob_attr *msg)
423 {
424 const struct blobmsg_policy *policy;
425 struct blob_attr *tb[__NODE_DATA_MAX];
426 struct usteer_local_node *ln;
427 struct blob_attr *val;
428 const char *name;
429 bool delete;
430
431 delete = !strncmp(method, "del", 3);
432 policy = delete ? del_node_data_policy : set_node_data_policy;
433
434 blobmsg_parse(policy, __NODE_DATA_MAX, tb, blob_data(msg), blob_len(msg));
435 if (!tb[NODE_DATA_NODE] || !tb[NODE_DATA_VALUES])
436 return UBUS_STATUS_INVALID_ARGUMENT;
437
438 name = blobmsg_get_string(tb[NODE_DATA_NODE]);
439 val = tb[NODE_DATA_VALUES];
440 if (delete && blobmsg_check_array(val, BLOBMSG_TYPE_STRING) < 0)
441 return UBUS_STATUS_INVALID_ARGUMENT;
442
443 if (strcmp(name, "*") != 0) {
444 ln = avl_find_element(&local_nodes, name, ln, node.avl);
445 if (!ln)
446 return UBUS_STATUS_NOT_FOUND;
447
448 usteer_update_kvlist_data(&ln->node_info, val, delete);
449 usteer_update_kvlist_blob(&ln->node.node_info, &ln->node_info);
450
451 return 0;
452 }
453
454 usteer_update_kvlist_data(&host_info, val, delete);
455 usteer_update_kvlist_blob(&host_info_blob, &host_info);
456
457 return 0;
458 }
459
460 static const struct ubus_method usteer_methods[] = {
461 UBUS_METHOD_NOARG("local_info", usteer_ubus_local_info),
462 UBUS_METHOD_NOARG("remote_hosts", usteer_ubus_remote_hosts),
463 UBUS_METHOD_NOARG("remote_info", usteer_ubus_remote_info),
464 UBUS_METHOD_NOARG("get_clients", usteer_ubus_get_clients),
465 UBUS_METHOD("get_client_info", usteer_ubus_get_client_info, client_arg),
466 UBUS_METHOD_NOARG("get_config", usteer_ubus_get_config),
467 UBUS_METHOD("set_config", usteer_ubus_set_config, config_policy),
468 UBUS_METHOD("update_config", usteer_ubus_set_config, config_policy),
469 UBUS_METHOD("set_node_data", usteer_ubus_update_node_data, set_node_data_policy),
470 UBUS_METHOD("delete_node_data", usteer_ubus_update_node_data, del_node_data_policy),
471 };
472
473 static struct ubus_object_type usteer_obj_type =
474 UBUS_OBJECT_TYPE("usteer", usteer_methods);
475
476 struct ubus_object usteer_obj = {
477 .name = "usteer",
478 .type = &usteer_obj_type,
479 .methods = usteer_methods,
480 .n_methods = ARRAY_SIZE(usteer_methods),
481 };
482
483 static bool
484 usteer_add_nr_entry(struct usteer_node *ln, struct usteer_node *node)
485 {
486 struct blobmsg_policy policy[3] = {
487 { .type = BLOBMSG_TYPE_STRING },
488 { .type = BLOBMSG_TYPE_STRING },
489 { .type = BLOBMSG_TYPE_STRING },
490 };
491 struct blob_attr *tb[3];
492
493 if (!node->rrm_nr)
494 return false;
495
496 if (strcmp(ln->ssid, node->ssid) != 0)
497 return false;
498
499 blobmsg_parse_array(policy, ARRAY_SIZE(tb), tb,
500 blobmsg_data(node->rrm_nr),
501 blobmsg_data_len(node->rrm_nr));
502 if (!tb[2])
503 return false;
504
505 blobmsg_add_field(&b, BLOBMSG_TYPE_STRING, "",
506 blobmsg_data(tb[2]),
507 blobmsg_data_len(tb[2]));
508
509 return true;
510 }
511
512 static void
513 usteer_ubus_disassoc_add_neighbors(struct sta_info *si)
514 {
515 struct usteer_node *node, *last_remote_neighbor = NULL;
516 int i = 0;
517 void *c;
518
519 c = blobmsg_open_array(&b, "neighbors");
520 for_each_local_node(node) {
521 if (i >= config.max_neighbor_reports)
522 break;
523 if (si->node == node)
524 continue;
525 if (usteer_add_nr_entry(si->node, node))
526 i++;
527 }
528
529 while (i < config.max_neighbor_reports) {
530 node = usteer_node_get_next_neighbor(si->node, last_remote_neighbor);
531 if (!node) {
532 /* No more nodes available */
533 break;
534 }
535
536 last_remote_neighbor = node;
537 if (usteer_add_nr_entry(si->node, node))
538 i++;
539 }
540 blobmsg_close_array(&b, c);
541 }
542
543 int usteer_ubus_notify_client_disassoc(struct sta_info *si)
544 {
545 struct usteer_local_node *ln = container_of(si->node, struct usteer_local_node, node);
546
547 blob_buf_init(&b, 0);
548 blobmsg_printf(&b, "addr", MAC_ADDR_FMT, MAC_ADDR_DATA(si->sta->addr));
549 blobmsg_add_u32(&b, "duration", config.roam_kick_delay);
550 usteer_ubus_disassoc_add_neighbors(si);
551 return ubus_invoke(ubus_ctx, ln->obj_id, "wnm_disassoc_imminent", b.head, NULL, 0, 100);
552 }
553
554 int usteer_ubus_trigger_client_scan(struct sta_info *si)
555 {
556 struct usteer_local_node *ln = container_of(si->node, struct usteer_local_node, node);
557
558 if (!usteer_sta_supports_beacon_measurement_mode(si->sta, BEACON_MEASUREMENT_ACTIVE)) {
559 MSG(DEBUG, "STA does not support beacon measurement sta=" MAC_ADDR_FMT "\n", MAC_ADDR_DATA(si->sta->addr));
560 return 0;
561 }
562
563 si->scan_band = !si->scan_band;
564
565 blob_buf_init(&b, 0);
566 blobmsg_printf(&b, "addr", MAC_ADDR_FMT, MAC_ADDR_DATA(si->sta->addr));
567 blobmsg_add_string(&b, "ssid", si->node->ssid);
568 blobmsg_add_u32(&b, "mode", BEACON_MEASUREMENT_ACTIVE);
569 blobmsg_add_u32(&b, "duration", config.roam_scan_interval / 100);
570 blobmsg_add_u32(&b, "channel", 0);
571 blobmsg_add_u32(&b, "op_class", si->scan_band ? 1 : 12);
572 return ubus_invoke(ubus_ctx, ln->obj_id, "rrm_beacon_req", b.head, NULL, 0, 100);
573 }
574
575 void usteer_ubus_kick_client(struct sta_info *si)
576 {
577 struct usteer_local_node *ln = container_of(si->node, struct usteer_local_node, node);
578
579 blob_buf_init(&b, 0);
580 blobmsg_printf(&b, "addr", MAC_ADDR_FMT, MAC_ADDR_DATA(si->sta->addr));
581 blobmsg_add_u32(&b, "reason", config.load_kick_reason_code);
582 blobmsg_add_u8(&b, "deauth", 1);
583 ubus_invoke(ubus_ctx, ln->obj_id, "del_client", b.head, NULL, 0, 100);
584 usteer_sta_disconnected(si);
585 si->roam_kick = current_time;
586 }
587
588 void usteer_ubus_init(struct ubus_context *ctx)
589 {
590 ubus_add_object(ctx, &usteer_obj);
591 }