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>
29 #include <libubox/avl-cmp.h>
30 #include <libubox/blobmsg_json.h>
34 AVL_TREE(local_nodes
, avl_strcmp
, false, NULL
);
35 static struct blob_buf b
;
36 static char *node_up_script
;
39 usteer_local_node_state_reset(struct usteer_local_node
*ln
)
41 if (ln
->req_state
== REQ_IDLE
)
44 ubus_abort_request(ubus_ctx
, &ln
->req
);
45 uloop_timeout_cancel(&ln
->req_timer
);
46 ln
->req_state
= REQ_IDLE
;
50 usteer_free_node(struct ubus_context
*ctx
, struct usteer_local_node
*ln
)
52 struct usteer_node_handler
*h
;
54 list_for_each_entry(h
, &node_handlers
, list
) {
57 h
->free_node(&ln
->node
);
60 usteer_local_node_state_reset(ln
);
61 usteer_sta_node_cleanup(&ln
->node
);
62 uloop_timeout_cancel(&ln
->update
);
63 avl_delete(&local_nodes
, &ln
->node
.avl
);
64 ubus_unregister_subscriber(ctx
, &ln
->ev
);
65 kvlist_free(&ln
->node_info
);
70 usteer_handle_remove(struct ubus_context
*ctx
, struct ubus_subscriber
*s
,
73 struct usteer_local_node
*ln
= container_of(s
, struct usteer_local_node
, ev
);
75 usteer_free_node(ctx
, ln
);
79 usteer_handle_event(struct ubus_context
*ctx
, struct ubus_object
*obj
,
80 struct ubus_request_data
*req
, const char *method
,
81 struct blob_attr
*msg
)
90 struct blobmsg_policy policy
[__EVENT_MAX
] = {
91 [EVENT_ADDR
] = { .name
= "address", .type
= BLOBMSG_TYPE_STRING
},
92 [EVENT_SIGNAL
] = { .name
= "signal", .type
= BLOBMSG_TYPE_INT32
},
93 [EVENT_TARGET
] = { .name
= "target", .type
= BLOBMSG_TYPE_STRING
},
94 [EVENT_FREQ
] = { .name
= "freq", .type
= BLOBMSG_TYPE_INT32
},
96 enum usteer_event_type ev_type
= __EVENT_TYPE_MAX
;
97 struct blob_attr
*tb
[__EVENT_MAX
];
98 struct usteer_local_node
*ln
;
99 struct usteer_node
*node
;
100 int signal
= NO_SIGNAL
;
102 const char *addr_str
;
107 usteer_update_time();
109 for (i
= 0; i
< ARRAY_SIZE(event_types
); i
++) {
110 if (strcmp(method
, event_types
[i
]) != 0)
117 ln
= container_of(obj
, struct usteer_local_node
, ev
.obj
);
119 blobmsg_parse(policy
, __EVENT_MAX
, tb
, blob_data(msg
), blob_len(msg
));
120 if (!tb
[EVENT_ADDR
] || !tb
[EVENT_FREQ
])
121 return UBUS_STATUS_INVALID_ARGUMENT
;
123 if (tb
[EVENT_SIGNAL
])
124 signal
= (int32_t) blobmsg_get_u32(tb
[EVENT_SIGNAL
]);
127 freq
= blobmsg_get_u32(tb
[EVENT_FREQ
]);
129 addr_str
= blobmsg_data(tb
[EVENT_ADDR
]);
130 addr
= (uint8_t *) ether_aton(addr_str
);
132 return UBUS_STATUS_INVALID_ARGUMENT
;
134 ret
= usteer_handle_sta_event(node
, addr
, ev_type
, freq
, signal
);
136 MSG(DEBUG
, "received %s event from %s, signal=%d, freq=%d, handled:%s\n",
137 method
, addr_str
, signal
, freq
, ret
? "true" : "false");
139 return ret
? 0 : 17 /* WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA */;
143 usteer_local_node_assoc_update(struct sta_info
*si
, struct blob_attr
*data
)
149 static struct blobmsg_policy policy
[__MSG_MAX
] = {
150 [MSG_ASSOC
] = { "assoc", BLOBMSG_TYPE_BOOL
},
152 struct blob_attr
*tb
[__MSG_MAX
];
154 blobmsg_parse(policy
, __MSG_MAX
, tb
, blobmsg_data(data
), blobmsg_data_len(data
));
155 if (tb
[MSG_ASSOC
] && blobmsg_get_u8(tb
[MSG_ASSOC
]))
158 if (si
->node
->freq
< 4000)
159 si
->sta
->seen_2ghz
= 1;
161 si
->sta
->seen_5ghz
= 1;
165 usteer_local_node_set_assoc(struct usteer_local_node
*ln
, struct blob_attr
*cl
)
167 struct usteer_node
*node
= &ln
->node
;
168 struct usteer_node_handler
*h
;
169 struct blob_attr
*cur
;
175 list_for_each_entry(si
, &node
->sta_info
, node_list
) {
180 blobmsg_for_each_attr(cur
, cl
, rem
) {
181 uint8_t *addr
= (uint8_t *) ether_aton(blobmsg_name(cur
));
187 sta
= usteer_sta_get(addr
, true);
188 si
= usteer_sta_info_get(sta
, node
, &create
);
189 list_for_each_entry(h
, &node_handlers
, list
) {
193 h
->update_sta(node
, si
);
195 usteer_local_node_assoc_update(si
, cur
);
196 if (si
->connected
== 1)
200 node
->n_assoc
= n_assoc
;
202 list_for_each_entry(si
, &node
->sta_info
, node_list
) {
203 if (si
->connected
!= 2)
207 usteer_sta_info_update_timeout(si
, config
.local_sta_timeout
);
208 MSG(VERBOSE
, "station "MAC_ADDR_FMT
" disconnected from node %s\n",
209 MAC_ADDR_DATA(si
->sta
->addr
), usteer_node_name(node
));
214 usteer_local_node_list_cb(struct ubus_request
*req
, int type
, struct blob_attr
*msg
)
221 static struct blobmsg_policy policy
[__MSG_MAX
] = {
222 [MSG_FREQ
] = { "freq", BLOBMSG_TYPE_INT32
},
223 [MSG_CLIENTS
] = { "clients", BLOBMSG_TYPE_TABLE
},
225 struct blob_attr
*tb
[__MSG_MAX
];
226 struct usteer_local_node
*ln
;
227 struct usteer_node
*node
;
229 ln
= container_of(req
, struct usteer_local_node
, req
);
232 blobmsg_parse(policy
, __MSG_MAX
, tb
, blob_data(msg
), blob_len(msg
));
233 if (!tb
[MSG_FREQ
] || !tb
[MSG_CLIENTS
])
236 node
->freq
= blobmsg_get_u32(tb
[MSG_FREQ
]);
237 usteer_local_node_set_assoc(ln
, tb
[MSG_CLIENTS
]);
241 usteer_local_node_rrm_nr_cb(struct ubus_request
*req
, int type
, struct blob_attr
*msg
)
243 static const struct blobmsg_policy policy
= {
244 "value", BLOBMSG_TYPE_ARRAY
246 struct usteer_local_node
*ln
;
247 struct blob_attr
*tb
;
249 ln
= container_of(req
, struct usteer_local_node
, req
);
251 blobmsg_parse(&policy
, 1, &tb
, blob_data(msg
), blob_len(msg
));
255 usteer_node_set_blob(&ln
->node
.rrm_nr
, tb
);
259 usteer_local_node_req_cb(struct ubus_request
*req
, int ret
)
261 struct usteer_local_node
*ln
;
263 ln
= container_of(req
, struct usteer_local_node
, req
);
264 uloop_timeout_set(&ln
->req_timer
, 1);
268 usteer_add_rrm_data(struct usteer_local_node
*ln
, struct usteer_node
*node
)
270 if (node
== &ln
->node
)
276 if (strcmp(ln
->node
.ssid
, node
->ssid
) != 0)
279 blobmsg_add_field(&b
, BLOBMSG_TYPE_ARRAY
, "",
280 blobmsg_data(node
->rrm_nr
),
281 blobmsg_data_len(node
->rrm_nr
));
285 usteer_local_node_prepare_rrm_set(struct usteer_local_node
*ln
)
287 struct usteer_remote_node
*rn
;
288 struct usteer_node
*node
;
291 c
= blobmsg_open_array(&b
, "list");
292 for_each_local_node(node
)
293 usteer_add_rrm_data(ln
, node
);
294 for_each_remote_node(rn
)
295 usteer_add_rrm_data(ln
, &rn
->node
);
296 blobmsg_close_array(&b
, c
);
300 usteer_local_node_state_next(struct uloop_timeout
*timeout
)
302 struct usteer_local_node
*ln
;
304 ln
= container_of(timeout
, struct usteer_local_node
, req_timer
);
307 if (ln
->req_state
>= __REQ_MAX
) {
308 ln
->req_state
= REQ_IDLE
;
312 blob_buf_init(&b
, 0);
313 switch (ln
->req_state
) {
315 ubus_invoke_async(ubus_ctx
, ln
->obj_id
, "get_clients", b
.head
, &ln
->req
);
316 ln
->req
.data_cb
= usteer_local_node_list_cb
;
318 case REQ_RRM_SET_LIST
:
319 usteer_local_node_prepare_rrm_set(ln
);
320 ubus_invoke_async(ubus_ctx
, ln
->obj_id
, "rrm_nr_set", b
.head
, &ln
->req
);
321 ln
->req
.data_cb
= NULL
;
323 case REQ_RRM_GET_OWN
:
324 ubus_invoke_async(ubus_ctx
, ln
->obj_id
, "rrm_nr_get_own", b
.head
, &ln
->req
);
325 ln
->req
.data_cb
= usteer_local_node_rrm_nr_cb
;
330 ln
->req
.complete_cb
= usteer_local_node_req_cb
;
331 ubus_complete_request_async(ubus_ctx
, &ln
->req
);
335 usteer_local_node_update(struct uloop_timeout
*timeout
)
337 struct usteer_local_node
*ln
;
338 struct usteer_node_handler
*h
;
339 struct usteer_node
*node
;
341 ln
= container_of(timeout
, struct usteer_local_node
, update
);
344 list_for_each_entry(h
, &node_handlers
, list
) {
348 h
->update_node(node
);
351 usteer_local_node_state_reset(ln
);
352 uloop_timeout_set(&ln
->req_timer
, 1);
353 usteer_local_node_kick(ln
);
354 uloop_timeout_set(timeout
, config
.local_sta_update
);
357 static struct usteer_local_node
*
358 usteer_get_node(struct ubus_context
*ctx
, const char *name
)
360 struct usteer_local_node
*ln
;
361 struct usteer_node
*node
;
364 ln
= avl_find_element(&local_nodes
, name
, ln
, node
.avl
);
368 ln
= calloc_a(sizeof(*ln
), &str
, strlen(name
) + 1);
370 node
->type
= NODE_TYPE_LOCAL
;
371 node
->avl
.key
= strcpy(str
, name
);
372 ln
->ev
.remove_cb
= usteer_handle_remove
;
373 ln
->ev
.cb
= usteer_handle_event
;
374 ln
->update
.cb
= usteer_local_node_update
;
375 ln
->req_timer
.cb
= usteer_local_node_state_next
;
376 ubus_register_subscriber(ctx
, &ln
->ev
);
377 avl_insert(&local_nodes
, &node
->avl
);
378 kvlist_init(&ln
->node_info
, kvlist_blob_len
);
379 INIT_LIST_HEAD(&node
->sta_info
);
385 usteer_node_run_update_script(struct usteer_node
*node
)
387 struct usteer_local_node
*ln
= container_of(node
, struct usteer_local_node
, node
);
393 val
= alloca(strlen(node_up_script
) + strlen(ln
->iface
) + 8);
394 sprintf(val
, "%s '%s'", node_up_script
, ln
->iface
);
396 MSG(INFO
, "failed to execute %s\n", val
);
400 usteer_check_node_enabled(struct usteer_local_node
*ln
)
402 bool ssid_disabled
= config
.ssid_list
;
403 struct blob_attr
*cur
;
406 blobmsg_for_each_attr(cur
, config
.ssid_list
, rem
) {
407 if (strcmp(blobmsg_get_string(cur
), ln
->node
.ssid
) != 0)
410 ssid_disabled
= false;
414 if (ln
->node
.disabled
== ssid_disabled
)
417 ln
->node
.disabled
= ssid_disabled
;
420 MSG(INFO
, "Disconnecting from local node %s\n", usteer_node_name(&ln
->node
));
421 usteer_local_node_state_reset(ln
);
422 usteer_sta_node_cleanup(&ln
->node
);
423 uloop_timeout_cancel(&ln
->update
);
424 ubus_unsubscribe(ubus_ctx
, &ln
->ev
, ln
->obj_id
);
428 MSG(INFO
, "Connecting to local node %s\n", usteer_node_name(&ln
->node
));
429 ubus_subscribe(ubus_ctx
, &ln
->ev
, ln
->obj_id
);
430 uloop_timeout_set(&ln
->update
, 1);
431 usteer_node_run_update_script(&ln
->node
);
435 usteer_register_node(struct ubus_context
*ctx
, const char *name
, uint32_t id
)
437 struct usteer_local_node
*ln
;
438 struct usteer_node_handler
*h
;
440 int offset
= sizeof("hostapd.") - 1;
442 iface
= name
+ offset
;
443 if (strncmp(name
, "hostapd.", iface
- name
) != 0)
446 MSG(INFO
, "Creating local node %s\n", name
);
447 ln
= usteer_get_node(ctx
, name
);
449 ln
->iface
= usteer_node_name(&ln
->node
) + offset
;
450 ln
->ifindex
= if_nametoindex(iface
);
452 blob_buf_init(&b
, 0);
453 blobmsg_add_u32(&b
, "notify_response", 1);
454 ubus_invoke(ctx
, id
, "notify_response", b
.head
, NULL
, NULL
, 1000);
456 blob_buf_init(&b
, 0);
457 blobmsg_add_u8(&b
, "neighbor_report", 1);
458 blobmsg_add_u8(&b
, "beacon_report", 1);
459 blobmsg_add_u8(&b
, "bss_transition", 1);
460 ubus_invoke(ctx
, id
, "bss_mgmt_enable", b
.head
, NULL
, NULL
, 1000);
462 list_for_each_entry(h
, &node_handlers
, list
) {
466 h
->init_node(&ln
->node
);
469 ln
->node
.disabled
= true;
470 usteer_check_node_enabled(ln
);
474 usteer_event_handler(struct ubus_context
*ctx
, struct ubus_event_handler
*ev
,
475 const char *type
, struct blob_attr
*msg
)
477 static const struct blobmsg_policy policy
[2] = {
478 { .name
= "id", .type
= BLOBMSG_TYPE_INT32
},
479 { .name
= "path", .type
= BLOBMSG_TYPE_STRING
},
481 struct blob_attr
*tb
[2];
484 blobmsg_parse(policy
, 2, tb
, blob_data(msg
), blob_len(msg
));
486 if (!tb
[0] || !tb
[1])
489 path
= blobmsg_data(tb
[1]);
490 usteer_register_node(ctx
, path
, blobmsg_get_u32(tb
[0]));
494 usteer_register_events(struct ubus_context
*ctx
)
496 static struct ubus_event_handler handler
= {
497 .cb
= usteer_event_handler
500 ubus_register_event_handler(ctx
, &handler
, "ubus.object.add");
504 node_list_cb(struct ubus_context
*ctx
, struct ubus_object_data
*obj
, void *priv
)
506 usteer_register_node(ctx
, obj
->path
, obj
->id
);
509 void usteer_local_node_update_node_info(struct usteer_local_node
*ln
)
511 struct blob_attr
*val
;
514 blob_buf_init(&b
, 0);
515 kvlist_for_each(&ln
->node_info
, name
, val
)
516 blobmsg_add_field(&b
, blobmsg_type(val
), name
,
517 blobmsg_data(val
), blobmsg_len(val
));
520 if (!blobmsg_len(val
))
523 usteer_node_set_blob(&ln
->node
.node_info
, val
);
526 void config_set_node_up_script(struct blob_attr
*data
)
529 struct usteer_node
*node
;
534 val
= blobmsg_get_string(data
);
535 if (node_up_script
&& !strcmp(val
, node_up_script
))
538 free(node_up_script
);
541 node_up_script
= NULL
;
545 node_up_script
= strdup(val
);
547 for_each_local_node(node
)
548 usteer_node_run_update_script(node
);
551 void config_get_node_up_script(struct blob_buf
*buf
)
556 blobmsg_add_string(buf
, "node_up_script", node_up_script
);
559 void config_set_ssid_list(struct blob_attr
*data
)
561 struct usteer_local_node
*ln
;
563 free(config
.ssid_list
);
565 if (data
&& blobmsg_len(data
))
566 config
.ssid_list
= blob_memdup(data
);
568 config
.ssid_list
= NULL
;
570 avl_for_each_element(&local_nodes
, ln
, node
.avl
)
571 usteer_check_node_enabled(ln
);
574 void config_get_ssid_list(struct blob_buf
*buf
)
576 if (config
.ssid_list
)
577 blobmsg_add_blob(buf
, config
.ssid_list
);
581 usteer_local_nodes_init(struct ubus_context
*ctx
)
583 usteer_register_events(ctx
);
584 ubus_lookup(ctx
, "hostapd.*", node_list_cb
, NULL
);