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), \
145 _cfg(U32, sta_block_timeout), \
146 _cfg(U32, local_sta_timeout), \
147 _cfg(U32, local_sta_update), \
148 _cfg(U32, max_retry_band), \
149 _cfg(U32, seen_policy_timeout), \
150 _cfg(U32, load_balancing_threshold), \
151 _cfg(U32, band_steering_threshold), \
152 _cfg(U32, remote_update_interval), \
153 _cfg(BOOL, assoc_steering), \
154 _cfg(I32, min_connect_snr), \
155 _cfg(I32, min_snr), \
156 _cfg(I32, roam_scan_snr), \
157 _cfg(U32, roam_scan_tries), \
158 _cfg(U32, roam_scan_interval), \
159 _cfg(I32, roam_trigger_snr), \
160 _cfg(U32, roam_trigger_interval), \
161 _cfg(U32, roam_kick_delay), \
162 _cfg(U32, signal_diff_threshold), \
163 _cfg(U32, initial_connect_delay), \
164 _cfg(BOOL, load_kick_enabled), \
165 _cfg(U32, load_kick_threshold), \
166 _cfg(U32, load_kick_delay), \
167 _cfg(U32, load_kick_min_clients), \
168 _cfg(U32, load_kick_reason_code), \
169 _cfg(ARRAY_CB, interfaces), \
170 _cfg(STRING_CB, node_up_script), \
171 _cfg(ARRAY_CB, event_log_types), \
172 _cfg(ARRAY_CB, ssid_list)
175 #define _cfg(_type, _name) CFG_##_name
181 static const struct blobmsg_policy config_policy
[__CFG_MAX
] = {
182 #define _cfg_policy(_type, _name) [CFG_##_name] = { .name = #_name, .type = BLOBMSG_TYPE_ ## _type }
183 #define _cfg_policy_BOOL(_name) _cfg_policy(BOOL, _name)
184 #define _cfg_policy_U32(_name) _cfg_policy(INT32, _name)
185 #define _cfg_policy_I32(_name) _cfg_policy(INT32, _name)
186 #define _cfg_policy_ARRAY_CB(_name) _cfg_policy(ARRAY, _name)
187 #define _cfg_policy_STRING_CB(_name) _cfg_policy(STRING, _name)
188 #define _cfg(_type, _name) _cfg_policy_##_type(_name)
193 static const struct cfg_item config_data
[__CFG_MAX
] = {
194 #define _cfg_data_BOOL(_name) .ptr.BOOL = &config._name
195 #define _cfg_data_U32(_name) .ptr.U32 = &config._name
196 #define _cfg_data_I32(_name) .ptr.I32 = &config._name
197 #define _cfg_data_ARRAY_CB(_name) .ptr.CB = { .set = config_set_##_name, .get = config_get_##_name }
198 #define _cfg_data_STRING_CB(_name) .ptr.CB = { .set = config_set_##_name, .get = config_get_##_name }
199 #define _cfg(_type, _name) [CFG_##_name] = { .type = CFG_##_type, _cfg_data_##_type(_name) }
205 usteer_ubus_get_config(struct ubus_context
*ctx
, struct ubus_object
*obj
,
206 struct ubus_request_data
*req
, const char *method
,
207 struct blob_attr
*msg
)
211 blob_buf_init(&b
, 0);
212 for (i
= 0; i
< __CFG_MAX
; i
++) {
213 switch(config_data
[i
].type
) {
215 blobmsg_add_u8(&b
, config_policy
[i
].name
,
216 *config_data
[i
].ptr
.BOOL
);
220 blobmsg_add_u32(&b
, config_policy
[i
].name
,
221 *config_data
[i
].ptr
.U32
);
225 config_data
[i
].ptr
.CB
.get(&b
);
229 ubus_send_reply(ctx
, req
, b
.head
);
234 usteer_ubus_set_config(struct ubus_context
*ctx
, struct ubus_object
*obj
,
235 struct ubus_request_data
*req
, const char *method
,
236 struct blob_attr
*msg
)
238 struct blob_attr
*tb
[__CFG_MAX
];
241 if (!strcmp(method
, "set_config"))
242 usteer_init_defaults();
244 blobmsg_parse(config_policy
, __CFG_MAX
, tb
, blob_data(msg
), blob_len(msg
));
245 for (i
= 0; i
< __CFG_MAX
; i
++) {
246 switch(config_data
[i
].type
) {
251 *config_data
[i
].ptr
.BOOL
= blobmsg_get_u8(tb
[i
]);
258 *config_data
[i
].ptr
.U32
= blobmsg_get_u32(tb
[i
]);
262 config_data
[i
].ptr
.CB
.set(tb
[i
]);
270 void usteer_dump_node(struct blob_buf
*buf
, struct usteer_node
*node
)
274 c
= blobmsg_open_table(buf
, usteer_node_name(node
));
275 blobmsg_add_u32(buf
, "freq", node
->freq
);
276 blobmsg_add_u32(buf
, "n_assoc", node
->n_assoc
);
277 blobmsg_add_u32(buf
, "noise", node
->noise
);
278 blobmsg_add_u32(buf
, "load", node
->load
);
279 blobmsg_add_u32(buf
, "max_assoc", node
->max_assoc
);
281 blobmsg_add_field(buf
, BLOBMSG_TYPE_ARRAY
, "rrm_nr",
282 blobmsg_data(node
->rrm_nr
),
283 blobmsg_data_len(node
->rrm_nr
));
285 blobmsg_add_field(buf
, BLOBMSG_TYPE_TABLE
, "node_info",
286 blob_data(node
->node_info
),
287 blob_len(node
->node_info
));
289 blobmsg_close_table(buf
, c
);
292 void usteer_dump_host(struct blob_buf
*buf
, struct usteer_remote_host
*host
)
296 c
= blobmsg_open_table(buf
, host
->addr
);
297 blobmsg_add_u32(buf
, "id", (uint32_t)(uintptr_t)host
->avl
.key
);
299 blobmsg_add_field(buf
, BLOBMSG_TYPE_TABLE
, "host_info",
300 blobmsg_data(host
->host_info
),
301 blobmsg_len(host
->host_info
));
302 blobmsg_close_table(buf
, c
);
306 usteer_ubus_local_info(struct ubus_context
*ctx
, struct ubus_object
*obj
,
307 struct ubus_request_data
*req
, const char *method
,
308 struct blob_attr
*msg
)
310 struct usteer_node
*node
;
312 blob_buf_init(&b
, 0);
314 for_each_local_node(node
)
315 usteer_dump_node(&b
, node
);
317 ubus_send_reply(ctx
, req
, b
.head
);
323 usteer_ubus_remote_hosts(struct ubus_context
*ctx
, struct ubus_object
*obj
,
324 struct ubus_request_data
*req
, const char *method
,
325 struct blob_attr
*msg
)
327 struct usteer_remote_host
*host
;
329 blob_buf_init(&b
, 0);
331 avl_for_each_element(&remote_hosts
, host
, avl
)
332 usteer_dump_host(&b
, host
);
334 ubus_send_reply(ctx
, req
, b
.head
);
340 usteer_ubus_remote_info(struct ubus_context
*ctx
, struct ubus_object
*obj
,
341 struct ubus_request_data
*req
, const char *method
,
342 struct blob_attr
*msg
)
344 struct usteer_remote_node
*rn
;
346 blob_buf_init(&b
, 0);
348 for_each_remote_node(rn
)
349 usteer_dump_node(&b
, &rn
->node
);
351 ubus_send_reply(ctx
, req
, b
.head
);
362 static const struct blobmsg_policy set_node_data_policy
[] = {
363 [NODE_DATA_NODE
] = { "node", BLOBMSG_TYPE_STRING
},
364 [NODE_DATA_VALUES
] = { "data", BLOBMSG_TYPE_TABLE
},
367 static const struct blobmsg_policy del_node_data_policy
[] = {
368 [NODE_DATA_NODE
] = { "node", BLOBMSG_TYPE_STRING
},
369 [NODE_DATA_VALUES
] = { "names", BLOBMSG_TYPE_ARRAY
},
373 usteer_update_kvlist_data(struct kvlist
*kv
, struct blob_attr
*data
,
376 struct blob_attr
*cur
;
379 blobmsg_for_each_attr(cur
, data
, rem
) {
381 kvlist_delete(kv
, blobmsg_get_string(cur
));
383 kvlist_set(kv
, blobmsg_name(cur
), cur
);
388 usteer_update_kvlist_blob(struct blob_attr
**dest
, struct kvlist
*kv
)
390 struct blob_attr
*val
;
393 blob_buf_init(&b
, 0);
394 kvlist_for_each(kv
, name
, val
)
395 blobmsg_add_field(&b
, blobmsg_type(val
), name
,
396 blobmsg_data(val
), blobmsg_len(val
));
399 if (!blobmsg_len(val
))
402 usteer_node_set_blob(dest
, val
);
406 usteer_ubus_update_node_data(struct ubus_context
*ctx
, struct ubus_object
*obj
,
407 struct ubus_request_data
*req
, const char *method
,
408 struct blob_attr
*msg
)
410 const struct blobmsg_policy
*policy
;
411 struct blob_attr
*tb
[__NODE_DATA_MAX
];
412 struct usteer_local_node
*ln
;
413 struct blob_attr
*val
;
417 delete = !strncmp(method
, "del", 3);
418 policy
= delete ? del_node_data_policy
: set_node_data_policy
;
420 blobmsg_parse(policy
, __NODE_DATA_MAX
, tb
, blob_data(msg
), blob_len(msg
));
421 if (!tb
[NODE_DATA_NODE
] || !tb
[NODE_DATA_VALUES
])
422 return UBUS_STATUS_INVALID_ARGUMENT
;
424 name
= blobmsg_get_string(tb
[NODE_DATA_NODE
]);
425 val
= tb
[NODE_DATA_VALUES
];
426 if (delete && blobmsg_check_array(val
, BLOBMSG_TYPE_STRING
) < 0)
427 return UBUS_STATUS_INVALID_ARGUMENT
;
429 if (strcmp(name
, "*") != 0) {
430 ln
= avl_find_element(&local_nodes
, name
, ln
, node
.avl
);
432 return UBUS_STATUS_NOT_FOUND
;
434 usteer_update_kvlist_data(&ln
->node_info
, val
, delete);
435 usteer_update_kvlist_blob(&ln
->node
.node_info
, &ln
->node_info
);
440 usteer_update_kvlist_data(&host_info
, val
, delete);
441 usteer_update_kvlist_blob(&host_info_blob
, &host_info
);
446 static const struct ubus_method usteer_methods
[] = {
447 UBUS_METHOD_NOARG("local_info", usteer_ubus_local_info
),
448 UBUS_METHOD_NOARG("remote_hosts", usteer_ubus_remote_hosts
),
449 UBUS_METHOD_NOARG("remote_info", usteer_ubus_remote_info
),
450 UBUS_METHOD_NOARG("get_clients", usteer_ubus_get_clients
),
451 UBUS_METHOD("get_client_info", usteer_ubus_get_client_info
, client_arg
),
452 UBUS_METHOD_NOARG("get_config", usteer_ubus_get_config
),
453 UBUS_METHOD("set_config", usteer_ubus_set_config
, config_policy
),
454 UBUS_METHOD("update_config", usteer_ubus_set_config
, config_policy
),
455 UBUS_METHOD("set_node_data", usteer_ubus_update_node_data
, set_node_data_policy
),
456 UBUS_METHOD("delete_node_data", usteer_ubus_update_node_data
, del_node_data_policy
),
459 static struct ubus_object_type usteer_obj_type
=
460 UBUS_OBJECT_TYPE("usteer", usteer_methods
);
462 struct ubus_object usteer_obj
= {
464 .type
= &usteer_obj_type
,
465 .methods
= usteer_methods
,
466 .n_methods
= ARRAY_SIZE(usteer_methods
),
470 usteer_add_nr_entry(struct usteer_node
*ln
, struct usteer_node
*node
)
472 struct blobmsg_policy policy
[3] = {
473 { .type
= BLOBMSG_TYPE_STRING
},
474 { .type
= BLOBMSG_TYPE_STRING
},
475 { .type
= BLOBMSG_TYPE_STRING
},
477 struct blob_attr
*tb
[3];
482 if (strcmp(ln
->ssid
, node
->ssid
) != 0)
485 blobmsg_parse_array(policy
, ARRAY_SIZE(tb
), tb
,
486 blobmsg_data(node
->rrm_nr
),
487 blobmsg_data_len(node
->rrm_nr
));
491 blobmsg_add_field(&b
, BLOBMSG_TYPE_STRING
, "",
493 blobmsg_data_len(tb
[2]));
496 int usteer_ubus_notify_client_disassoc(struct sta_info
*si
)
498 struct usteer_local_node
*ln
= container_of(si
->node
, struct usteer_local_node
, node
);
499 struct usteer_remote_node
*rn
;
500 struct usteer_node
*node
;
503 blob_buf_init(&b
, 0);
504 blobmsg_printf(&b
, "addr", MAC_ADDR_FMT
, MAC_ADDR_DATA(si
->sta
->addr
));
505 blobmsg_add_u32(&b
, "duration", config
.roam_kick_delay
);
506 c
= blobmsg_open_array(&b
, "neighbors");
507 for_each_local_node(node
)
508 usteer_add_nr_entry(si
->node
, node
);
509 for_each_remote_node(rn
)
510 usteer_add_nr_entry(si
->node
, &rn
->node
);
511 blobmsg_close_array(&b
, c
);
512 return ubus_invoke(ubus_ctx
, ln
->obj_id
, "wnm_disassoc_imminent", b
.head
, NULL
, 0, 100);
515 int usteer_ubus_trigger_client_scan(struct sta_info
*si
)
517 struct usteer_local_node
*ln
= container_of(si
->node
, struct usteer_local_node
, node
);
519 si
->scan_band
= !si
->scan_band
;
521 blob_buf_init(&b
, 0);
522 blobmsg_printf(&b
, "addr", MAC_ADDR_FMT
, MAC_ADDR_DATA(si
->sta
->addr
));
523 blobmsg_add_u32(&b
, "mode", 1);
524 blobmsg_add_u32(&b
, "duration", 65535);
525 blobmsg_add_u32(&b
, "channel", 255);
526 blobmsg_add_u32(&b
, "op_class", si
->scan_band
? 1 : 12);
527 return ubus_invoke(ubus_ctx
, ln
->obj_id
, "rrm_beacon_req", b
.head
, NULL
, 0, 100);
530 void usteer_ubus_kick_client(struct sta_info
*si
)
532 struct usteer_local_node
*ln
= container_of(si
->node
, struct usteer_local_node
, node
);
534 blob_buf_init(&b
, 0);
535 blobmsg_printf(&b
, "addr", MAC_ADDR_FMT
, MAC_ADDR_DATA(si
->sta
->addr
));
536 blobmsg_add_u32(&b
, "reason", config
.load_kick_reason_code
);
537 blobmsg_add_u8(&b
, "deauth", 1);
538 ubus_invoke(ubus_ctx
, ln
->obj_id
, "del_client", b
.head
, NULL
, 0, 100);
540 si
->roam_kick
= current_time
;
543 void usteer_ubus_init(struct ubus_context
*ctx
)
545 ubus_add_object(ctx
, &usteer_obj
);