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.
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.
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.
15 * Copyright (C) 2020 embedd.ch
16 * Copyright (C) 2020 Felix Fietkau <nbd@nbd.name>
17 * Copyright (C) 2020 John Crispin <john@phrozen.org>
20 #include <sys/types.h>
21 #include <sys/socket.h>
22 #include <net/ethernet.h>
24 #include <netinet/ether.h>
31 static struct blob_buf b
;
32 static KVLIST(host_info
, kvlist_blob_len
);
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
)
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
);
54 blobmsg_close_table(&b
, _s
);
56 ubus_send_reply(ctx
, req
, b
.head
);
60 static struct blobmsg_policy client_arg
[] = {
61 { .name
= "address", .type
= BLOBMSG_TYPE_STRING
, },
65 usteer_ubus_add_stats(struct sta_info_stats
*stats
, const char *name
)
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
);
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
)
83 struct blob_attr
*mac_str
;
85 void *_n
, *_cur_n
, *_s
;
88 blobmsg_parse(client_arg
, 1, &mac_str
, blob_data(msg
), blob_len(msg
));
90 return UBUS_STATUS_INVALID_ARGUMENT
;
92 mac
= (uint8_t *) ether_aton(blobmsg_data(mac_str
));
94 return UBUS_STATUS_INVALID_ARGUMENT
;
96 sta
= usteer_sta_get(mac
, false);
98 return UBUS_STATUS_NOT_FOUND
;
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
);
114 blobmsg_close_table(&b
, _n
);
116 ubus_send_reply(ctx
, req
, b
.head
);
136 void (*set
)(struct blob_attr
*data
);
137 void (*get
)(struct blob_buf
*buf
);
142 #define __config_items \
143 _cfg(BOOL, syslog), \
144 _cfg(U32, debug_level), \
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)
178 #define _cfg(_type, _name) CFG_##_name
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)
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) }
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
)
214 blob_buf_init(&b
, 0);
215 for (i
= 0; i
< __CFG_MAX
; i
++) {
216 switch(config_data
[i
].type
) {
218 blobmsg_add_u8(&b
, config_policy
[i
].name
,
219 *config_data
[i
].ptr
.BOOL
);
223 blobmsg_add_u32(&b
, config_policy
[i
].name
,
224 *config_data
[i
].ptr
.U32
);
228 config_data
[i
].ptr
.CB
.get(&b
);
232 ubus_send_reply(ctx
, req
, b
.head
);
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
)
241 struct blob_attr
*tb
[__CFG_MAX
];
244 if (!strcmp(method
, "set_config"))
245 usteer_init_defaults();
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
) {
254 *config_data
[i
].ptr
.BOOL
= blobmsg_get_u8(tb
[i
]);
261 *config_data
[i
].ptr
.U32
= blobmsg_get_u32(tb
[i
]);
265 config_data
[i
].ptr
.CB
.set(tb
[i
]);
270 usteer_interface_init();
275 void usteer_dump_node(struct blob_buf
*buf
, struct usteer_node
*node
)
277 void *c
, *roam_events
;
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
);
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
);
293 blobmsg_add_field(buf
, BLOBMSG_TYPE_ARRAY
, "rrm_nr",
294 blobmsg_data(node
->rrm_nr
),
295 blobmsg_data_len(node
->rrm_nr
));
297 blobmsg_add_field(buf
, BLOBMSG_TYPE_TABLE
, "node_info",
298 blob_data(node
->node_info
),
299 blob_len(node
->node_info
));
301 blobmsg_close_table(buf
, c
);
304 void usteer_dump_host(struct blob_buf
*buf
, struct usteer_remote_host
*host
)
308 c
= blobmsg_open_table(buf
, host
->addr
);
309 blobmsg_add_u32(buf
, "id", (uint32_t)(uintptr_t)host
->avl
.key
);
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
);
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
)
322 struct usteer_node
*node
;
324 blob_buf_init(&b
, 0);
326 for_each_local_node(node
)
327 usteer_dump_node(&b
, node
);
329 ubus_send_reply(ctx
, req
, b
.head
);
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
)
339 struct usteer_remote_host
*host
;
341 blob_buf_init(&b
, 0);
343 avl_for_each_element(&remote_hosts
, host
, avl
)
344 usteer_dump_host(&b
, host
);
346 ubus_send_reply(ctx
, req
, b
.head
);
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
)
356 struct usteer_remote_node
*rn
;
358 blob_buf_init(&b
, 0);
360 for_each_remote_node(rn
)
361 usteer_dump_node(&b
, &rn
->node
);
363 ubus_send_reply(ctx
, req
, b
.head
);
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
},
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
},
385 usteer_update_kvlist_data(struct kvlist
*kv
, struct blob_attr
*data
,
388 struct blob_attr
*cur
;
391 blobmsg_for_each_attr(cur
, data
, rem
) {
393 kvlist_delete(kv
, blobmsg_get_string(cur
));
395 kvlist_set(kv
, blobmsg_name(cur
), cur
);
400 usteer_update_kvlist_blob(struct blob_attr
**dest
, struct kvlist
*kv
)
402 struct blob_attr
*val
;
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
));
411 if (!blobmsg_len(val
))
414 usteer_node_set_blob(dest
, val
);
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
)
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
;
429 delete = !strncmp(method
, "del", 3);
430 policy
= delete ? del_node_data_policy
: set_node_data_policy
;
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
;
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
;
441 if (strcmp(name
, "*") != 0) {
442 ln
= avl_find_element(&local_nodes
, name
, ln
, node
.avl
);
444 return UBUS_STATUS_NOT_FOUND
;
446 usteer_update_kvlist_data(&ln
->node_info
, val
, delete);
447 usteer_update_kvlist_blob(&ln
->node
.node_info
, &ln
->node_info
);
452 usteer_update_kvlist_data(&host_info
, val
, delete);
453 usteer_update_kvlist_blob(&host_info_blob
, &host_info
);
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
),
471 static struct ubus_object_type usteer_obj_type
=
472 UBUS_OBJECT_TYPE("usteer", usteer_methods
);
474 struct ubus_object usteer_obj
= {
476 .type
= &usteer_obj_type
,
477 .methods
= usteer_methods
,
478 .n_methods
= ARRAY_SIZE(usteer_methods
),
482 usteer_add_nr_entry(struct usteer_node
*ln
, struct usteer_node
*node
)
484 struct blobmsg_policy policy
[3] = {
485 { .type
= BLOBMSG_TYPE_STRING
},
486 { .type
= BLOBMSG_TYPE_STRING
},
487 { .type
= BLOBMSG_TYPE_STRING
},
489 struct blob_attr
*tb
[3];
494 if (strcmp(ln
->ssid
, node
->ssid
) != 0)
497 blobmsg_parse_array(policy
, ARRAY_SIZE(tb
), tb
,
498 blobmsg_data(node
->rrm_nr
),
499 blobmsg_data_len(node
->rrm_nr
));
503 blobmsg_add_field(&b
, BLOBMSG_TYPE_STRING
, "",
505 blobmsg_data_len(tb
[2]));
511 usteer_ubus_disassoc_add_neighbors(struct sta_info
*si
)
513 struct usteer_node
*node
, *last_remote_neighbor
= NULL
;
517 c
= blobmsg_open_array(&b
, "neighbors");
518 for_each_local_node(node
) {
519 if (i
>= config
.max_neighbor_reports
)
521 if (si
->node
== node
)
523 if (usteer_add_nr_entry(si
->node
, node
))
527 while (i
< config
.max_neighbor_reports
) {
528 node
= usteer_node_get_next_neighbor(si
->node
, last_remote_neighbor
);
530 /* No more nodes available */
534 last_remote_neighbor
= node
;
535 if (usteer_add_nr_entry(si
->node
, node
))
538 blobmsg_close_array(&b
, c
);
541 int usteer_ubus_notify_client_disassoc(struct sta_info
*si
)
543 struct usteer_local_node
*ln
= container_of(si
->node
, struct usteer_local_node
, node
);
545 blob_buf_init(&b
, 0);
546 blobmsg_printf(&b
, "addr", MAC_ADDR_FMT
, MAC_ADDR_DATA(si
->sta
->addr
));
547 blobmsg_add_u32(&b
, "duration", config
.roam_kick_delay
);
548 usteer_ubus_disassoc_add_neighbors(si
);
549 return ubus_invoke(ubus_ctx
, ln
->obj_id
, "wnm_disassoc_imminent", b
.head
, NULL
, 0, 100);
552 int usteer_ubus_trigger_client_scan(struct sta_info
*si
)
554 struct usteer_local_node
*ln
= container_of(si
->node
, struct usteer_local_node
, node
);
556 if (!usteer_sta_supports_beacon_measurement_mode(si
->sta
, BEACON_MEASUREMENT_ACTIVE
)) {
557 MSG(DEBUG
, "STA does not support beacon measurement sta=" MAC_ADDR_FMT
"\n", MAC_ADDR_DATA(si
->sta
->addr
));
561 si
->scan_band
= !si
->scan_band
;
563 blob_buf_init(&b
, 0);
564 blobmsg_printf(&b
, "addr", MAC_ADDR_FMT
, MAC_ADDR_DATA(si
->sta
->addr
));
565 blobmsg_add_u32(&b
, "mode", BEACON_MEASUREMENT_ACTIVE
);
566 blobmsg_add_u32(&b
, "duration", config
.roam_scan_interval
/ 100);
567 blobmsg_add_u32(&b
, "channel", 0);
568 blobmsg_add_u32(&b
, "op_class", si
->scan_band
? 1 : 12);
569 return ubus_invoke(ubus_ctx
, ln
->obj_id
, "rrm_beacon_req", b
.head
, NULL
, 0, 100);
572 void usteer_ubus_kick_client(struct sta_info
*si
)
574 struct usteer_local_node
*ln
= container_of(si
->node
, struct usteer_local_node
, node
);
576 blob_buf_init(&b
, 0);
577 blobmsg_printf(&b
, "addr", MAC_ADDR_FMT
, MAC_ADDR_DATA(si
->sta
->addr
));
578 blobmsg_add_u32(&b
, "reason", config
.load_kick_reason_code
);
579 blobmsg_add_u8(&b
, "deauth", 1);
580 ubus_invoke(ubus_ctx
, ln
->obj_id
, "del_client", b
.head
, NULL
, 0, 100);
581 usteer_sta_disconnected(si
);
582 si
->roam_kick
= current_time
;
585 void usteer_ubus_init(struct ubus_context
*ctx
)
587 ubus_add_object(ctx
, &usteer_obj
);