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(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)
180 #define _cfg(_type, _name) CFG_##_name
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)
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) }
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
)
216 blob_buf_init(&b
, 0);
217 for (i
= 0; i
< __CFG_MAX
; i
++) {
218 switch(config_data
[i
].type
) {
220 blobmsg_add_u8(&b
, config_policy
[i
].name
,
221 *config_data
[i
].ptr
.BOOL
);
225 blobmsg_add_u32(&b
, config_policy
[i
].name
,
226 *config_data
[i
].ptr
.U32
);
230 config_data
[i
].ptr
.CB
.get(&b
);
234 ubus_send_reply(ctx
, req
, b
.head
);
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
)
243 struct blob_attr
*tb
[__CFG_MAX
];
246 if (!strcmp(method
, "set_config"))
247 usteer_init_defaults();
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
) {
256 *config_data
[i
].ptr
.BOOL
= blobmsg_get_u8(tb
[i
]);
263 *config_data
[i
].ptr
.U32
= blobmsg_get_u32(tb
[i
]);
267 config_data
[i
].ptr
.CB
.set(tb
[i
]);
272 usteer_interface_init();
277 void usteer_dump_node(struct blob_buf
*buf
, struct usteer_node
*node
)
279 void *c
, *roam_events
;
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
);
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
);
295 blobmsg_add_field(buf
, BLOBMSG_TYPE_ARRAY
, "rrm_nr",
296 blobmsg_data(node
->rrm_nr
),
297 blobmsg_data_len(node
->rrm_nr
));
299 blobmsg_add_field(buf
, BLOBMSG_TYPE_TABLE
, "node_info",
300 blob_data(node
->node_info
),
301 blob_len(node
->node_info
));
303 blobmsg_close_table(buf
, c
);
306 void usteer_dump_host(struct blob_buf
*buf
, struct usteer_remote_host
*host
)
310 c
= blobmsg_open_table(buf
, host
->addr
);
311 blobmsg_add_u32(buf
, "id", (uint32_t)(uintptr_t)host
->avl
.key
);
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
);
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
)
324 struct usteer_node
*node
;
326 blob_buf_init(&b
, 0);
328 for_each_local_node(node
)
329 usteer_dump_node(&b
, node
);
331 ubus_send_reply(ctx
, req
, b
.head
);
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
)
341 struct usteer_remote_host
*host
;
343 blob_buf_init(&b
, 0);
345 avl_for_each_element(&remote_hosts
, host
, avl
)
346 usteer_dump_host(&b
, host
);
348 ubus_send_reply(ctx
, req
, b
.head
);
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
)
358 struct usteer_remote_node
*rn
;
360 blob_buf_init(&b
, 0);
362 for_each_remote_node(rn
)
363 usteer_dump_node(&b
, &rn
->node
);
365 ubus_send_reply(ctx
, req
, b
.head
);
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
},
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
},
387 usteer_update_kvlist_data(struct kvlist
*kv
, struct blob_attr
*data
,
390 struct blob_attr
*cur
;
393 blobmsg_for_each_attr(cur
, data
, rem
) {
395 kvlist_delete(kv
, blobmsg_get_string(cur
));
397 kvlist_set(kv
, blobmsg_name(cur
), cur
);
402 usteer_update_kvlist_blob(struct blob_attr
**dest
, struct kvlist
*kv
)
404 struct blob_attr
*val
;
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
));
413 if (!blobmsg_len(val
))
416 usteer_node_set_blob(dest
, val
);
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
)
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
;
431 delete = !strncmp(method
, "del", 3);
432 policy
= delete ? del_node_data_policy
: set_node_data_policy
;
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
;
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
;
443 if (strcmp(name
, "*") != 0) {
444 ln
= avl_find_element(&local_nodes
, name
, ln
, node
.avl
);
446 return UBUS_STATUS_NOT_FOUND
;
448 usteer_update_kvlist_data(&ln
->node_info
, val
, delete);
449 usteer_update_kvlist_blob(&ln
->node
.node_info
, &ln
->node_info
);
454 usteer_update_kvlist_data(&host_info
, val
, delete);
455 usteer_update_kvlist_blob(&host_info_blob
, &host_info
);
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
),
473 static struct ubus_object_type usteer_obj_type
=
474 UBUS_OBJECT_TYPE("usteer", usteer_methods
);
476 struct ubus_object usteer_obj
= {
478 .type
= &usteer_obj_type
,
479 .methods
= usteer_methods
,
480 .n_methods
= ARRAY_SIZE(usteer_methods
),
484 usteer_add_nr_entry(struct usteer_node
*ln
, struct usteer_node
*node
)
486 struct blobmsg_policy policy
[3] = {
487 { .type
= BLOBMSG_TYPE_STRING
},
488 { .type
= BLOBMSG_TYPE_STRING
},
489 { .type
= BLOBMSG_TYPE_STRING
},
491 struct blob_attr
*tb
[3];
496 if (strcmp(ln
->ssid
, node
->ssid
) != 0)
499 blobmsg_parse_array(policy
, ARRAY_SIZE(tb
), tb
,
500 blobmsg_data(node
->rrm_nr
),
501 blobmsg_data_len(node
->rrm_nr
));
505 blobmsg_add_field(&b
, BLOBMSG_TYPE_STRING
, "",
507 blobmsg_data_len(tb
[2]));
513 usteer_ubus_disassoc_add_neighbors(struct sta_info
*si
)
515 struct usteer_node
*node
, *last_remote_neighbor
= NULL
;
519 c
= blobmsg_open_array(&b
, "neighbors");
520 for_each_local_node(node
) {
521 if (i
>= config
.max_neighbor_reports
)
523 if (si
->node
== node
)
525 if (usteer_add_nr_entry(si
->node
, node
))
529 while (i
< config
.max_neighbor_reports
) {
530 node
= usteer_node_get_next_neighbor(si
->node
, last_remote_neighbor
);
532 /* No more nodes available */
536 last_remote_neighbor
= node
;
537 if (usteer_add_nr_entry(si
->node
, node
))
540 blobmsg_close_array(&b
, c
);
543 int usteer_ubus_notify_client_disassoc(struct sta_info
*si
)
545 struct usteer_local_node
*ln
= container_of(si
->node
, struct usteer_local_node
, node
);
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);
554 int usteer_ubus_trigger_client_scan(struct sta_info
*si
)
556 struct usteer_local_node
*ln
= container_of(si
->node
, struct usteer_local_node
, node
);
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
));
563 si
->scan_band
= !si
->scan_band
;
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);
575 void usteer_ubus_kick_client(struct sta_info
*si
)
577 struct usteer_local_node
*ln
= container_of(si
->node
, struct usteer_local_node
, node
);
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
;
588 void usteer_ubus_init(struct ubus_context
*ctx
)
590 ubus_add_object(ctx
, &usteer_obj
);