1 // SPDX-License-Identifier: GPL-2.0+
3 * Copyright (C) 2022 Felix Fietkau <nbd@nbd.name>
7 #include <sys/socket.h>
10 #include <libubox/avl-cmp.h>
11 #include <libubox/utils.h>
12 #include <libubox/blobmsg_json.h>
19 NETDATA_ATTR_SERVICES
,
23 static const struct blobmsg_policy netdata_policy
[__NETDATA_ATTR_MAX
] = {
24 [NETDATA_ATTR_CONFIG
] = { "config", BLOBMSG_TYPE_TABLE
},
25 [NETDATA_ATTR_HOSTS
] = { "hosts", BLOBMSG_TYPE_TABLE
},
26 [NETDATA_ATTR_SERVICES
] = { "services", BLOBMSG_TYPE_TABLE
},
32 NETCONF_ATTR_PEX_PORT
,
33 NETCONF_ATTR_KEEPALIVE
,
37 static const struct blobmsg_policy netconf_policy
[__NETCONF_ATTR_MAX
] = {
38 [NETCONF_ATTR_ID
] = { "id", BLOBMSG_TYPE_STRING
},
39 [NETCONF_ATTR_PORT
] = { "port", BLOBMSG_TYPE_INT32
},
40 [NETCONF_ATTR_PEX_PORT
] = { "peer-exchange-port", BLOBMSG_TYPE_INT32
},
41 [NETCONF_ATTR_KEEPALIVE
] = { "keepalive", BLOBMSG_TYPE_INT32
},
44 const struct blobmsg_policy network_policy
[__NETWORK_ATTR_MAX
] = {
45 [NETWORK_ATTR_NAME
] = { "name", BLOBMSG_TYPE_STRING
},
46 [NETWORK_ATTR_TYPE
] = { "type", BLOBMSG_TYPE_STRING
},
47 [NETWORK_ATTR_AUTH_KEY
] = { "auth_key", BLOBMSG_TYPE_STRING
},
48 [NETWORK_ATTR_KEY
] = { "key", BLOBMSG_TYPE_STRING
},
49 [NETWORK_ATTR_FILE
] = { "file", BLOBMSG_TYPE_STRING
},
50 [NETWORK_ATTR_DATA
] = { "data", BLOBMSG_TYPE_TABLE
},
51 [NETWORK_ATTR_INTERFACE
] = { "interface", BLOBMSG_TYPE_STRING
},
52 [NETWORK_ATTR_KEEPALIVE
] = { "keepalive", BLOBMSG_TYPE_INT32
},
53 [NETWORK_ATTR_DOMAIN
] = { "domain", BLOBMSG_TYPE_STRING
},
54 [NETWORK_ATTR_UPDATE_CMD
] = { "update-cmd", BLOBMSG_TYPE_STRING
},
55 [NETWORK_ATTR_TUNNELS
] = { "tunnels", BLOBMSG_TYPE_TABLE
},
58 AVL_TREE(networks
, avl_strcmp
, false, NULL
);
59 static struct blob_buf b
;
61 static void network_load_config_data(struct network
*net
, struct blob_attr
*data
)
63 struct blob_attr
*tb
[__NETCONF_ATTR_MAX
];
64 struct blob_attr
*cur
;
65 siphash_key_t key
= {};
67 blobmsg_parse(netconf_policy
, __NETCONF_ATTR_MAX
, tb
,
68 blobmsg_data(data
), blobmsg_len(data
));
70 if ((cur
= tb
[NETCONF_ATTR_PORT
]) != NULL
)
71 net
->net_config
.port
= blobmsg_get_u32(cur
);
73 net
->net_config
.port
= 51820;
75 if ((cur
= tb
[NETCONF_ATTR_PEX_PORT
]) != NULL
)
76 net
->net_config
.pex_port
= blobmsg_get_u32(cur
);
78 if ((cur
= tb
[NETCONF_ATTR_ID
]) != NULL
) {
79 const char *id
= blobmsg_get_string(cur
);
80 siphash_to_le64(&net
->net_config
.addr
.network_id
, id
, strlen(id
), &key
);
82 siphash_to_le64(&net
->net_config
.addr
.network_id
, &net
->net_config
.port
,
83 sizeof(net
->net_config
.port
), &key
);
86 net
->net_config
.addr
.network_id
[0] = 0xfd;
87 network_fill_host_addr(&net
->net_config
.addr
, net
->config
.pubkey
);
89 if (net
->config
.keepalive
>= 0)
90 net
->net_config
.keepalive
= net
->config
.keepalive
;
91 else if ((cur
= tb
[NETCONF_ATTR_KEEPALIVE
]) != NULL
)
92 net
->net_config
.keepalive
= blobmsg_get_u32(cur
);
94 net
->net_config
.keepalive
= 0;
97 static int network_load_data(struct network
*net
, struct blob_attr
*data
)
99 struct blob_attr
*tb
[__NETDATA_ATTR_MAX
];
101 blobmsg_parse(netdata_policy
, __NETDATA_ATTR_MAX
, tb
,
102 blobmsg_data(data
), blobmsg_len(data
));
104 network_load_config_data(net
, tb
[NETDATA_ATTR_CONFIG
]);
105 network_hosts_add(net
, tb
[NETDATA_ATTR_HOSTS
]);
106 network_services_add(net
, tb
[NETDATA_ATTR_SERVICES
]);
111 static int network_load_file(struct network
*net
)
113 blob_buf_init(&b
, 0);
115 if (!blobmsg_add_json_from_file(&b
, net
->config
.file
))
118 return network_load_data(net
, b
.head
);
121 static int network_load_dynamic(struct network
*net
)
123 const char *json
= NULL
;
129 asprintf(&fname
, "%s/%s.bin", data_dir
, network_name(net
));
130 f
= fopen(fname
, "r");
134 D_NET(net
, "failed to open %s/%s.bin\n", data_dir
, network_name(net
));
138 if (fstat(fileno(f
), &st
) < 0)
141 net
->net_data_len
= st
.st_size
;
142 net
->net_data
= realloc(net
->net_data
, net
->net_data_len
+ 1);
143 memset(net
->net_data
+ net
->net_data_len
, 0, 1);
144 if (fread(net
->net_data
, 1, net
->net_data_len
, f
) != net
->net_data_len
||
145 unet_auth_data_validate(net
->config
.auth_key
, net
->net_data
,
146 net
->net_data_len
, &json
)) {
147 net
->net_data_len
= 0;
152 blob_buf_init(&b
, 0);
153 if (!blobmsg_add_json_from_string(&b
, json
)) {
154 net
->net_data_len
= 0;
158 return network_load_data(net
, b
.head
);
166 network_fill_ip(struct blob_buf
*buf
, int af
, union network_addr
*addr
, int mask
)
171 c
= blobmsg_open_table(buf
, NULL
);
173 blobmsg_printf(buf
, "mask", "%d", mask
);
175 str
= blobmsg_alloc_string_buffer(buf
, "ipaddr", INET6_ADDRSTRLEN
);
176 inet_ntop(af
, addr
, str
, INET6_ADDRSTRLEN
);
177 blobmsg_add_string_buffer(buf
);
179 blobmsg_close_table(buf
, c
);
183 network_fill_ipaddr_list(struct network_host
*host
, struct blob_buf
*b
, bool ipv6
)
185 union network_addr addr
= {};
186 struct blob_attr
*cur
;
191 af
= ipv6
? AF_INET6
: AF_INET
;
192 blobmsg_for_each_attr(cur
, host
->peer
.ipaddr
, rem
) {
193 const char *str
= blobmsg_get_string(cur
);
195 if (!!strchr(str
, ':') != ipv6
)
198 if (inet_pton(af
, str
, &addr
) != 1)
201 c
= blobmsg_open_table(b
, NULL
);
202 blobmsg_add_string(b
, "ipaddr", str
);
203 blobmsg_add_string(b
, "mask", ipv6
? "128" : "32");
204 blobmsg_close_table(b
, c
);
209 network_fill_ip_settings(struct network
*net
, struct blob_buf
*buf
)
211 struct network_host
*host
= net
->net_config
.local_host
;
214 c
= blobmsg_open_array(buf
, "ipaddr");
215 network_fill_ipaddr_list(host
, buf
, false);
216 blobmsg_close_array(buf
, c
);
218 c
= blobmsg_open_array(buf
, "ip6addr");
219 network_fill_ip(buf
, AF_INET6
, &host
->peer
.local_addr
, 64);
220 network_fill_ipaddr_list(host
, buf
, true);
221 blobmsg_close_array(buf
, c
);
225 __network_fill_host_subnets(struct network_host
*host
, struct blob_buf
*b
, bool ipv6
)
227 union network_addr addr
= {};
228 struct blob_attr
*cur
;
234 af
= ipv6
? AF_INET6
: AF_INET
;
235 blobmsg_for_each_attr(cur
, host
->peer
.subnet
, rem
) {
236 const char *str
= blobmsg_get_string(cur
);
239 if (!!strchr(str
, ':') != ipv6
)
242 if (network_get_subnet(af
, &addr
, &mask
, str
))
245 c
= blobmsg_open_table(b
, NULL
);
247 buf
= blobmsg_alloc_string_buffer(b
, "target", INET6_ADDRSTRLEN
);
248 inet_ntop(af
, &addr
, buf
, INET6_ADDRSTRLEN
);
249 blobmsg_add_string_buffer(b
);
251 blobmsg_printf(b
, "netmask", "%d", mask
);
253 blobmsg_close_table(b
, c
);
256 blobmsg_for_each_attr(cur
, host
->peer
.ipaddr
, rem
) {
257 const char *str
= blobmsg_get_string(cur
);
259 if (!!strchr(str
, ':') != ipv6
)
262 if (inet_pton(af
, str
, &addr
) != 1)
265 c
= blobmsg_open_table(b
, NULL
);
266 blobmsg_add_string(b
, "target", str
);
267 blobmsg_add_string(b
, "netmask", ipv6
? "128" : "32");
268 blobmsg_close_table(b
, c
);
273 __network_fill_subnets(struct network
*net
, struct blob_buf
*buf
, bool ipv6
)
275 struct network_host
*host
;
278 c
= blobmsg_open_array(buf
, ipv6
? "routes6": "routes");
279 avl_for_each_element(&net
->hosts
, host
, node
) {
280 if (host
== net
->net_config
.local_host
)
282 __network_fill_host_subnets(host
, buf
, ipv6
);
284 blobmsg_close_array(buf
, c
);
289 network_fill_subnets(struct network
*net
, struct blob_buf
*buf
)
291 __network_fill_subnets(net
, buf
, false);
292 __network_fill_subnets(net
, buf
, true);
296 network_do_update(struct network
*net
, bool up
)
298 if (!net
->net_config
.local_host
)
301 blob_buf_init(&b
, 0);
302 blobmsg_add_u32(&b
, "action", 0);
303 blobmsg_add_string(&b
, "ifname", network_name(net
));
304 blobmsg_add_u8(&b
, "link-up", up
);
307 network_fill_ip_settings(net
, &b
);
308 network_fill_subnets(net
, &b
);
312 char *s
= blobmsg_format_json(b
.head
, true);
313 D_NET(net
, "update: %s", s
);
317 if (net
->config
.update_cmd
) {
318 const char *argv
[] = { net
->config
.update_cmd
, NULL
, NULL
};
323 argv
[1] = blobmsg_format_json(b
.head
, true);
324 execvp(argv
[0], (char **)argv
);
327 waitpid(pid
, &stat
, 0);
330 if (!net
->config
.interface
)
333 blobmsg_add_string(&b
, "interface", net
->config
.interface
);
334 unetd_ubus_netifd_update(b
.head
);
337 static int network_reload(struct network
*net
)
341 net
->prev_local_host
= net
->net_config
.local_host
;
343 memset(&net
->net_config
, 0, sizeof(net
->net_config
));
345 network_pex_close(net
);
346 network_services_free(net
);
347 network_hosts_update_start(net
);
348 network_services_update_start(net
);
350 switch (net
->config
.type
) {
351 case NETWORK_TYPE_FILE
:
352 ret
= network_load_file(net
);
354 case NETWORK_TYPE_INLINE
:
355 ret
= network_load_data(net
, net
->config
.net_data
);
357 case NETWORK_TYPE_DYNAMIC
:
358 ret
= network_load_dynamic(net
);
362 network_services_update_done(net
);
363 network_hosts_update_done(net
);
364 uloop_timeout_set(&net
->connect_timer
, 10);
366 net
->prev_local_host
= NULL
;
369 network_do_update(net
, true);
370 network_pex_open(net
);
375 static int network_setup(struct network
*net
)
377 if (wg_init_network(net
)) {
378 fprintf(stderr
, "Setup failed for network %s\n", network_name(net
));
382 net
->ifindex
= if_nametoindex(network_name(net
));
384 fprintf(stderr
, "Could not get ifindex for network %s\n", network_name(net
));
391 static void network_teardown(struct network
*net
)
393 network_do_update(net
, false);
394 network_pex_close(net
);
395 network_hosts_free(net
);
396 network_services_free(net
);
397 wg_cleanup_network(net
);
401 network_destroy(struct network
*net
)
403 network_teardown(net
);
404 avl_delete(&networks
, &net
->node
);
406 free(net
->config
.data
);
411 network_set_config(struct network
*net
, struct blob_attr
*config
)
413 struct blob_attr
*tb
[__NETWORK_ATTR_MAX
];
414 struct blob_attr
*cur
;
416 if (net
->config
.data
&& blob_attr_equal(net
->config
.data
, config
))
419 network_teardown(net
);
421 free(net
->config
.data
);
422 memset(&net
->config
, 0, sizeof(net
->config
));
424 net
->config
.data
= blob_memdup(config
);
425 blobmsg_parse(network_policy
, __NETWORK_ATTR_MAX
, tb
,
426 blobmsg_data(net
->config
.data
),
427 blobmsg_len(net
->config
.data
));
429 if ((cur
= tb
[NETWORK_ATTR_TYPE
]) == NULL
||
430 !strcmp(blobmsg_get_string(cur
), "dynamic"))
431 net
->config
.type
= NETWORK_TYPE_DYNAMIC
;
432 else if (!strcmp(blobmsg_get_string(cur
), "file"))
433 net
->config
.type
= NETWORK_TYPE_FILE
;
434 else if (!strcmp(blobmsg_get_string(cur
), "inline"))
435 net
->config
.type
= NETWORK_TYPE_INLINE
;
439 if ((cur
= tb
[NETWORK_ATTR_KEEPALIVE
]) != NULL
)
440 net
->config
.keepalive
= blobmsg_get_u32(cur
);
442 net
->config
.keepalive
= -1;
444 switch (net
->config
.type
) {
445 case NETWORK_TYPE_FILE
:
446 if ((cur
= tb
[NETWORK_ATTR_FILE
]) != NULL
)
447 net
->config
.file
= blobmsg_get_string(cur
);
451 case NETWORK_TYPE_INLINE
:
452 net
->config
.net_data
= tb
[NETWORK_ATTR_DATA
];
453 if (!net
->config
.net_data
)
456 case NETWORK_TYPE_DYNAMIC
:
457 if ((cur
= tb
[NETWORK_ATTR_AUTH_KEY
]) == NULL
)
460 if (b64_decode(blobmsg_get_string(cur
), net
->config
.auth_key
,
461 sizeof(net
->config
.auth_key
)) != sizeof(net
->config
.auth_key
))
466 if ((cur
= tb
[NETWORK_ATTR_INTERFACE
]) != NULL
)
467 net
->config
.interface
= blobmsg_get_string(cur
);
469 if ((cur
= tb
[NETWORK_ATTR_UPDATE_CMD
]) != NULL
)
470 net
->config
.update_cmd
= blobmsg_get_string(cur
);
472 if ((cur
= tb
[NETWORK_ATTR_DOMAIN
]) != NULL
)
473 net
->config
.domain
= blobmsg_get_string(cur
);
475 if ((cur
= tb
[NETWORK_ATTR_TUNNELS
]) != NULL
)
476 net
->config
.tunnels
= cur
;
478 if ((cur
= tb
[NETWORK_ATTR_KEY
]) == NULL
)
481 if (b64_decode(blobmsg_get_string(cur
), net
->config
.key
, sizeof(net
->config
.key
)) !=
482 sizeof(net
->config
.key
))
485 curve25519_generate_public(net
->config
.pubkey
, net
->config
.key
);
487 if (network_setup(net
))
496 network_destroy(net
);
500 static struct network
*
501 network_alloc(const char *name
)
506 net
= calloc_a(sizeof(*net
), &name_buf
, strlen(name
) + 1);
507 net
->node
.key
= strcpy(name_buf
, name
);
508 avl_insert(&networks
, &net
->node
);
510 network_pex_init(net
);
511 network_hosts_init(net
);
512 network_services_init(net
);
517 void network_fill_host_addr(union network_addr
*addr
, uint8_t *pubkey
)
519 siphash_key_t key
= {
521 get_unaligned_le64(addr
->network_id
),
522 get_unaligned_le64(addr
->network_id
)
526 siphash_to_le64(&addr
->host_addr
, pubkey
, CURVE25519_KEY_SIZE
, &key
);
529 int unetd_network_add(const char *name
, struct blob_attr
*config
)
533 if (strchr(name
, '/'))
536 net
= avl_find_element(&networks
, name
, net
, node
);
538 net
= network_alloc(name
);
540 return network_set_config(net
, config
);
543 int unetd_network_remove(const char *name
)
547 net
= avl_find_element(&networks
, name
, net
, node
);
551 network_destroy(net
);
556 void network_free_all(void)
558 struct network
*net
, *tmp
;
560 avl_for_each_element_safe(&networks
, net
, node
, tmp
)
561 network_destroy(net
);