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_retry_band), \
150 _cfg(U32, seen_policy_timeout), \
151 _cfg(U32, load_balancing_threshold), \
152 _cfg(U32, band_steering_threshold), \
153 _cfg(U32, remote_update_interval), \
154 _cfg(BOOL, assoc_steering), \
155 _cfg(I32, min_connect_snr), \
156 _cfg(I32, min_snr), \
157 _cfg(I32, roam_scan_snr), \
158 _cfg(U32, roam_scan_tries), \
159 _cfg(U32, roam_scan_interval), \
160 _cfg(I32, roam_trigger_snr), \
161 _cfg(U32, roam_trigger_interval), \
162 _cfg(U32, roam_kick_delay), \
163 _cfg(U32, signal_diff_threshold), \
164 _cfg(U32, initial_connect_delay), \
165 _cfg(BOOL, load_kick_enabled), \
166 _cfg(U32, load_kick_threshold), \
167 _cfg(U32, load_kick_delay), \
168 _cfg(U32, load_kick_min_clients), \
169 _cfg(U32, load_kick_reason_code), \
170 _cfg(ARRAY_CB, interfaces), \
171 _cfg(STRING_CB, node_up_script), \
172 _cfg(ARRAY_CB, event_log_types), \
173 _cfg(ARRAY_CB, ssid_list)
176 #define _cfg(_type, _name) CFG_##_name
182 static const struct blobmsg_policy config_policy
[__CFG_MAX
] = {
183 #define _cfg_policy(_type, _name) [CFG_##_name] = { .name = #_name, .type = BLOBMSG_TYPE_ ## _type }
184 #define _cfg_policy_BOOL(_name) _cfg_policy(BOOL, _name)
185 #define _cfg_policy_U32(_name) _cfg_policy(INT32, _name)
186 #define _cfg_policy_I32(_name) _cfg_policy(INT32, _name)
187 #define _cfg_policy_ARRAY_CB(_name) _cfg_policy(ARRAY, _name)
188 #define _cfg_policy_STRING_CB(_name) _cfg_policy(STRING, _name)
189 #define _cfg(_type, _name) _cfg_policy_##_type(_name)
194 static const struct cfg_item config_data
[__CFG_MAX
] = {
195 #define _cfg_data_BOOL(_name) .ptr.BOOL = &config._name
196 #define _cfg_data_U32(_name) .ptr.U32 = &config._name
197 #define _cfg_data_I32(_name) .ptr.I32 = &config._name
198 #define _cfg_data_ARRAY_CB(_name) .ptr.CB = { .set = config_set_##_name, .get = config_get_##_name }
199 #define _cfg_data_STRING_CB(_name) .ptr.CB = { .set = config_set_##_name, .get = config_get_##_name }
200 #define _cfg(_type, _name) [CFG_##_name] = { .type = CFG_##_type, _cfg_data_##_type(_name) }
206 usteer_ubus_get_config(struct ubus_context
*ctx
, struct ubus_object
*obj
,
207 struct ubus_request_data
*req
, const char *method
,
208 struct blob_attr
*msg
)
212 blob_buf_init(&b
, 0);
213 for (i
= 0; i
< __CFG_MAX
; i
++) {
214 switch(config_data
[i
].type
) {
216 blobmsg_add_u8(&b
, config_policy
[i
].name
,
217 *config_data
[i
].ptr
.BOOL
);
221 blobmsg_add_u32(&b
, config_policy
[i
].name
,
222 *config_data
[i
].ptr
.U32
);
226 config_data
[i
].ptr
.CB
.get(&b
);
230 ubus_send_reply(ctx
, req
, b
.head
);
235 usteer_ubus_set_config(struct ubus_context
*ctx
, struct ubus_object
*obj
,
236 struct ubus_request_data
*req
, const char *method
,
237 struct blob_attr
*msg
)
239 struct blob_attr
*tb
[__CFG_MAX
];
242 if (!strcmp(method
, "set_config"))
243 usteer_init_defaults();
245 blobmsg_parse(config_policy
, __CFG_MAX
, tb
, blob_data(msg
), blob_len(msg
));
246 for (i
= 0; i
< __CFG_MAX
; i
++) {
247 switch(config_data
[i
].type
) {
252 *config_data
[i
].ptr
.BOOL
= blobmsg_get_u8(tb
[i
]);
259 *config_data
[i
].ptr
.U32
= blobmsg_get_u32(tb
[i
]);
263 config_data
[i
].ptr
.CB
.set(tb
[i
]);
268 usteer_interface_init();
273 void usteer_dump_node(struct blob_buf
*buf
, struct usteer_node
*node
)
277 c
= blobmsg_open_table(buf
, usteer_node_name(node
));
278 blobmsg_add_u32(buf
, "freq", node
->freq
);
279 blobmsg_add_u32(buf
, "n_assoc", node
->n_assoc
);
280 blobmsg_add_u32(buf
, "noise", node
->noise
);
281 blobmsg_add_u32(buf
, "load", node
->load
);
282 blobmsg_add_u32(buf
, "max_assoc", node
->max_assoc
);
284 blobmsg_add_field(buf
, BLOBMSG_TYPE_ARRAY
, "rrm_nr",
285 blobmsg_data(node
->rrm_nr
),
286 blobmsg_data_len(node
->rrm_nr
));
288 blobmsg_add_field(buf
, BLOBMSG_TYPE_TABLE
, "node_info",
289 blob_data(node
->node_info
),
290 blob_len(node
->node_info
));
292 blobmsg_close_table(buf
, c
);
295 void usteer_dump_host(struct blob_buf
*buf
, struct usteer_remote_host
*host
)
299 c
= blobmsg_open_table(buf
, host
->addr
);
300 blobmsg_add_u32(buf
, "id", (uint32_t)(uintptr_t)host
->avl
.key
);
302 blobmsg_add_field(buf
, BLOBMSG_TYPE_TABLE
, "host_info",
303 blobmsg_data(host
->host_info
),
304 blobmsg_len(host
->host_info
));
305 blobmsg_close_table(buf
, c
);
309 usteer_ubus_local_info(struct ubus_context
*ctx
, struct ubus_object
*obj
,
310 struct ubus_request_data
*req
, const char *method
,
311 struct blob_attr
*msg
)
313 struct usteer_node
*node
;
315 blob_buf_init(&b
, 0);
317 for_each_local_node(node
)
318 usteer_dump_node(&b
, node
);
320 ubus_send_reply(ctx
, req
, b
.head
);
326 usteer_ubus_remote_hosts(struct ubus_context
*ctx
, struct ubus_object
*obj
,
327 struct ubus_request_data
*req
, const char *method
,
328 struct blob_attr
*msg
)
330 struct usteer_remote_host
*host
;
332 blob_buf_init(&b
, 0);
334 avl_for_each_element(&remote_hosts
, host
, avl
)
335 usteer_dump_host(&b
, host
);
337 ubus_send_reply(ctx
, req
, b
.head
);
343 usteer_ubus_remote_info(struct ubus_context
*ctx
, struct ubus_object
*obj
,
344 struct ubus_request_data
*req
, const char *method
,
345 struct blob_attr
*msg
)
347 struct usteer_remote_node
*rn
;
349 blob_buf_init(&b
, 0);
351 for_each_remote_node(rn
)
352 usteer_dump_node(&b
, &rn
->node
);
354 ubus_send_reply(ctx
, req
, b
.head
);
365 static const struct blobmsg_policy set_node_data_policy
[] = {
366 [NODE_DATA_NODE
] = { "node", BLOBMSG_TYPE_STRING
},
367 [NODE_DATA_VALUES
] = { "data", BLOBMSG_TYPE_TABLE
},
370 static const struct blobmsg_policy del_node_data_policy
[] = {
371 [NODE_DATA_NODE
] = { "node", BLOBMSG_TYPE_STRING
},
372 [NODE_DATA_VALUES
] = { "names", BLOBMSG_TYPE_ARRAY
},
376 usteer_update_kvlist_data(struct kvlist
*kv
, struct blob_attr
*data
,
379 struct blob_attr
*cur
;
382 blobmsg_for_each_attr(cur
, data
, rem
) {
384 kvlist_delete(kv
, blobmsg_get_string(cur
));
386 kvlist_set(kv
, blobmsg_name(cur
), cur
);
391 usteer_update_kvlist_blob(struct blob_attr
**dest
, struct kvlist
*kv
)
393 struct blob_attr
*val
;
396 blob_buf_init(&b
, 0);
397 kvlist_for_each(kv
, name
, val
)
398 blobmsg_add_field(&b
, blobmsg_type(val
), name
,
399 blobmsg_data(val
), blobmsg_len(val
));
402 if (!blobmsg_len(val
))
405 usteer_node_set_blob(dest
, val
);
409 usteer_ubus_update_node_data(struct ubus_context
*ctx
, struct ubus_object
*obj
,
410 struct ubus_request_data
*req
, const char *method
,
411 struct blob_attr
*msg
)
413 const struct blobmsg_policy
*policy
;
414 struct blob_attr
*tb
[__NODE_DATA_MAX
];
415 struct usteer_local_node
*ln
;
416 struct blob_attr
*val
;
420 delete = !strncmp(method
, "del", 3);
421 policy
= delete ? del_node_data_policy
: set_node_data_policy
;
423 blobmsg_parse(policy
, __NODE_DATA_MAX
, tb
, blob_data(msg
), blob_len(msg
));
424 if (!tb
[NODE_DATA_NODE
] || !tb
[NODE_DATA_VALUES
])
425 return UBUS_STATUS_INVALID_ARGUMENT
;
427 name
= blobmsg_get_string(tb
[NODE_DATA_NODE
]);
428 val
= tb
[NODE_DATA_VALUES
];
429 if (delete && blobmsg_check_array(val
, BLOBMSG_TYPE_STRING
) < 0)
430 return UBUS_STATUS_INVALID_ARGUMENT
;
432 if (strcmp(name
, "*") != 0) {
433 ln
= avl_find_element(&local_nodes
, name
, ln
, node
.avl
);
435 return UBUS_STATUS_NOT_FOUND
;
437 usteer_update_kvlist_data(&ln
->node_info
, val
, delete);
438 usteer_update_kvlist_blob(&ln
->node
.node_info
, &ln
->node_info
);
443 usteer_update_kvlist_data(&host_info
, val
, delete);
444 usteer_update_kvlist_blob(&host_info_blob
, &host_info
);
449 static const struct ubus_method usteer_methods
[] = {
450 UBUS_METHOD_NOARG("local_info", usteer_ubus_local_info
),
451 UBUS_METHOD_NOARG("remote_hosts", usteer_ubus_remote_hosts
),
452 UBUS_METHOD_NOARG("remote_info", usteer_ubus_remote_info
),
453 UBUS_METHOD_NOARG("get_clients", usteer_ubus_get_clients
),
454 UBUS_METHOD("get_client_info", usteer_ubus_get_client_info
, client_arg
),
455 UBUS_METHOD_NOARG("get_config", usteer_ubus_get_config
),
456 UBUS_METHOD("set_config", usteer_ubus_set_config
, config_policy
),
457 UBUS_METHOD("update_config", usteer_ubus_set_config
, config_policy
),
458 UBUS_METHOD("set_node_data", usteer_ubus_update_node_data
, set_node_data_policy
),
459 UBUS_METHOD("delete_node_data", usteer_ubus_update_node_data
, del_node_data_policy
),
462 static struct ubus_object_type usteer_obj_type
=
463 UBUS_OBJECT_TYPE("usteer", usteer_methods
);
465 struct ubus_object usteer_obj
= {
467 .type
= &usteer_obj_type
,
468 .methods
= usteer_methods
,
469 .n_methods
= ARRAY_SIZE(usteer_methods
),
473 usteer_add_nr_entry(struct usteer_node
*ln
, struct usteer_node
*node
)
475 struct blobmsg_policy policy
[3] = {
476 { .type
= BLOBMSG_TYPE_STRING
},
477 { .type
= BLOBMSG_TYPE_STRING
},
478 { .type
= BLOBMSG_TYPE_STRING
},
480 struct blob_attr
*tb
[3];
485 if (strcmp(ln
->ssid
, node
->ssid
) != 0)
488 blobmsg_parse_array(policy
, ARRAY_SIZE(tb
), tb
,
489 blobmsg_data(node
->rrm_nr
),
490 blobmsg_data_len(node
->rrm_nr
));
494 blobmsg_add_field(&b
, BLOBMSG_TYPE_STRING
, "",
496 blobmsg_data_len(tb
[2]));
499 int usteer_ubus_notify_client_disassoc(struct sta_info
*si
)
501 struct usteer_local_node
*ln
= container_of(si
->node
, struct usteer_local_node
, node
);
502 struct usteer_remote_node
*rn
;
503 struct usteer_node
*node
;
506 blob_buf_init(&b
, 0);
507 blobmsg_printf(&b
, "addr", MAC_ADDR_FMT
, MAC_ADDR_DATA(si
->sta
->addr
));
508 blobmsg_add_u32(&b
, "duration", config
.roam_kick_delay
);
509 c
= blobmsg_open_array(&b
, "neighbors");
510 for_each_local_node(node
)
511 usteer_add_nr_entry(si
->node
, node
);
512 for_each_remote_node(rn
)
513 usteer_add_nr_entry(si
->node
, &rn
->node
);
514 blobmsg_close_array(&b
, c
);
515 return ubus_invoke(ubus_ctx
, ln
->obj_id
, "wnm_disassoc_imminent", b
.head
, NULL
, 0, 100);
518 int usteer_ubus_trigger_client_scan(struct sta_info
*si
)
520 struct usteer_local_node
*ln
= container_of(si
->node
, struct usteer_local_node
, node
);
522 si
->scan_band
= !si
->scan_band
;
524 blob_buf_init(&b
, 0);
525 blobmsg_printf(&b
, "addr", MAC_ADDR_FMT
, MAC_ADDR_DATA(si
->sta
->addr
));
526 blobmsg_add_u32(&b
, "mode", 1);
527 blobmsg_add_u32(&b
, "duration", 65535);
528 blobmsg_add_u32(&b
, "channel", 255);
529 blobmsg_add_u32(&b
, "op_class", si
->scan_band
? 1 : 12);
530 return ubus_invoke(ubus_ctx
, ln
->obj_id
, "rrm_beacon_req", b
.head
, NULL
, 0, 100);
533 void usteer_ubus_kick_client(struct sta_info
*si
)
535 struct usteer_local_node
*ln
= container_of(si
->node
, struct usteer_local_node
, node
);
537 blob_buf_init(&b
, 0);
538 blobmsg_printf(&b
, "addr", MAC_ADDR_FMT
, MAC_ADDR_DATA(si
->sta
->addr
));
539 blobmsg_add_u32(&b
, "reason", config
.load_kick_reason_code
);
540 blobmsg_add_u8(&b
, "deauth", 1);
541 ubus_invoke(ubus_ctx
, ln
->obj_id
, "del_client", b
.head
, NULL
, 0, 100);
543 si
->roam_kick
= current_time
;
546 void usteer_ubus_init(struct ubus_context
*ctx
)
548 ubus_add_object(ctx
, &usteer_obj
);