3 Copyright (C) 2014-2017 Guus Sliepen <guus@meshlink.io>
5 This program is free software; you can redistribute it and/or modify
6 it under the terms of the GNU General Public License as published by
7 the Free Software Foundation; either version 2 of the License, or
8 (at your option) any later version.
10 This program is distributed in the hope that it will be useful,
11 but WITHOUT ANY WARRANTY; without even the implied warranty of
12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 GNU General Public License for more details.
15 You should have received a copy of the GNU General Public License along
16 with this program; if not, write to the Free Software Foundation, Inc.,
17 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
23 #include "connection.h"
27 #include "meshlink_internal.h"
37 /// Helper function to start parsing a host config file
38 static bool node_get_config(meshlink_handle_t *mesh, node_t *n, config_t *config, packmsg_input_t *in) {
39 if(!config_read(mesh, "current", n->name, config, mesh->config_key)) {
43 in->ptr = config->buf;
44 in->len = config->len;
46 uint32_t version = packmsg_get_uint32(in);
48 if(version != MESHLINK_CONFIG_VERSION) {
49 logger(mesh, MESHLINK_ERROR, "Invalid config file for node %s", n->name);
55 uint32_t len = packmsg_get_str_raw(in, &name);
57 if(len != strlen(n->name) || !name || strncmp(name, n->name, len)) {
58 logger(mesh, MESHLINK_ERROR, "Invalid config file for node %s", n->name);
66 /// Read the public key from a host config file. Used whenever we need to start an SPTPS session.
67 bool node_read_public_key(meshlink_handle_t *mesh, node_t *n) {
68 if(ecdsa_active(n->ecdsa)) {
75 if(!node_get_config(mesh, n, &config, &in)) {
79 packmsg_skip_element(&in); /* submesh */
80 packmsg_get_int32(&in); /* devclass */
81 packmsg_get_bool(&in); /* blacklisted */
84 uint32_t len = packmsg_get_bin_raw(&in, &key);
91 n->ecdsa = ecdsa_set_public_key(key);
93 // While we are at it, read known address information
94 if(!n->canonical_address) {
95 n->canonical_address = packmsg_get_str_dup(&in);
97 packmsg_skip_element(&in);
100 // Append any known addresses in the config file to the list we currently have
101 uint32_t known_count = 0;
103 for(uint32_t i = 0; i < 5; i++) {
104 if(n->recent[i].sa.sa_family) {
109 uint32_t count = packmsg_get_array(&in);
111 if(count > 5 - known_count) {
112 count = 5 - known_count;
115 for(uint32_t i = 0; i < count; i++) {
116 n->recent[i + known_count] = packmsg_get_sockaddr(&in);
120 config_free(&config);
124 /// Fill in node details from a config blob.
125 bool node_read_from_config(meshlink_handle_t *mesh, node_t *n, const config_t *config) {
126 if(n->canonical_address) {
130 packmsg_input_t in = {config->buf, config->len};
131 uint32_t version = packmsg_get_uint32(&in);
133 if(version != MESHLINK_CONFIG_VERSION) {
137 char *name = packmsg_get_str_dup(&in);
144 if(strcmp(n->name, name)) {
154 char *submesh_name = packmsg_get_str_dup(&in);
156 if(!strcmp(submesh_name, CORE_MESH)) {
160 n->submesh = lookup_or_create_submesh(mesh, submesh_name);
168 n->devclass = packmsg_get_int32(&in);
169 n->status.blacklisted = packmsg_get_bool(&in);
171 uint32_t len = packmsg_get_bin_raw(&in, &key);
177 if(!ecdsa_active(n->ecdsa)) {
178 n->ecdsa = ecdsa_set_public_key(key);
181 n->canonical_address = packmsg_get_str_dup(&in);
182 uint32_t count = packmsg_get_array(&in);
188 for(uint32_t i = 0; i < count; i++) {
189 n->recent[i] = packmsg_get_sockaddr(&in);
192 return packmsg_done(&in);
195 bool node_write_config(meshlink_handle_t *mesh, node_t *n) {
196 if(!mesh->confbase) {
201 packmsg_output_t out = {buf, sizeof(buf)};
203 packmsg_add_uint32(&out, MESHLINK_CONFIG_VERSION);
204 packmsg_add_str(&out, n->name);
205 packmsg_add_str(&out, n->submesh ? n->submesh->name : CORE_MESH);
206 packmsg_add_int32(&out, n->devclass);
207 packmsg_add_bool(&out, n->status.blacklisted);
209 if(ecdsa_active(n->ecdsa)) {
210 packmsg_add_bin(&out, ecdsa_get_public_key(n->ecdsa), 32);
212 packmsg_add_bin(&out, "", 0);
215 packmsg_add_str(&out, n->canonical_address ? n->canonical_address : "");
219 for(uint32_t i = 0; i < 5; i++) {
220 if(n->recent[i].sa.sa_family) {
227 packmsg_add_array(&out, count);
229 for(uint32_t i = 0; i < count; i++) {
230 packmsg_add_sockaddr(&out, &n->recent[i]);
233 if(!packmsg_output_ok(&out)) {
237 config_t config = {buf, packmsg_output_size(&out, buf)};
239 if(!config_write(mesh, "current", n->name, &config, mesh->config_key)) {
240 call_error_cb(mesh, MESHLINK_ESTORAGE);
247 static bool load_node(meshlink_handle_t *mesh, const char *name, void *priv) {
250 if(!check_id(name)) {
254 node_t *n = lookup_node(mesh, name);
261 n->name = xstrdup(name);
266 if(!node_get_config(mesh, n, &config, &in)) {
271 if(!node_read_from_config(mesh, n, &config)) {
272 logger(mesh, MESHLINK_ERROR, "Invalid config file for node %s", n->name);
273 config_free(&config);
278 config_free(&config);
286 Add listening sockets.
288 static bool add_listen_address(meshlink_handle_t *mesh, char *address, bool bindto) {
289 char *port = mesh->myport;
292 char *space = strchr(address, ' ');
299 if(!strcmp(address, "*")) {
306 struct addrinfo hint = {
307 .ai_family = AF_UNSPEC,
308 .ai_socktype = SOCK_STREAM,
309 .ai_protocol = IPPROTO_TCP,
310 .ai_flags = AI_PASSIVE,
313 int err = getaddrinfo(address && *address ? address : NULL, port, &hint, &ai);
318 logger(mesh, MESHLINK_ERROR, "System call `%s' failed: %s", "getaddrinfo", err == EAI_SYSTEM ? strerror(err) : gai_strerror(err));
322 bool success = false;
324 for(struct addrinfo *aip = ai; aip; aip = aip->ai_next) {
325 // Ignore duplicate addresses
328 for(int i = 0; i < mesh->listen_sockets; i++)
329 if(!memcmp(&mesh->listen_socket[i].sa, aip->ai_addr, aip->ai_addrlen)) {
338 if(mesh->listen_sockets >= MAXSOCKETS) {
339 logger(mesh, MESHLINK_ERROR, "Too many listening sockets");
343 int tcp_fd = setup_listen_socket((sockaddr_t *) aip->ai_addr);
349 int udp_fd = setup_vpn_in_socket(mesh, (sockaddr_t *) aip->ai_addr);
356 io_add(&mesh->loop, &mesh->listen_socket[mesh->listen_sockets].tcp, handle_new_meta_connection, &mesh->listen_socket[mesh->listen_sockets], tcp_fd, IO_READ);
357 io_add(&mesh->loop, &mesh->listen_socket[mesh->listen_sockets].udp, handle_incoming_vpn_data, &mesh->listen_socket[mesh->listen_sockets], udp_fd, IO_READ);
359 if(mesh->log_level >= MESHLINK_INFO) {
360 char *hostname = sockaddr2hostname((sockaddr_t *) aip->ai_addr);
361 logger(mesh, MESHLINK_INFO, "Listening on %s", hostname);
365 mesh->listen_socket[mesh->listen_sockets].bindto = bindto;
366 memcpy(&mesh->listen_socket[mesh->listen_sockets].sa, aip->ai_addr, aip->ai_addrlen);
367 memcpy(&mesh->listen_socket[mesh->listen_sockets].broadcast_sa, aip->ai_addr, aip->ai_addrlen);
369 if(aip->ai_family == AF_INET6) {
370 mesh->listen_socket[mesh->listen_sockets].broadcast_sa.in6.sin6_addr.s6_addr[0x0] = 0xff;
371 mesh->listen_socket[mesh->listen_sockets].broadcast_sa.in6.sin6_addr.s6_addr[0x1] = 0x02;
372 mesh->listen_socket[mesh->listen_sockets].broadcast_sa.in6.sin6_addr.s6_addr[0xf] = 0x01;
374 mesh->listen_socket[mesh->listen_sockets].broadcast_sa.in.sin_addr.s_addr = 0xffffffff;
377 mesh->listen_sockets++;
386 Configure node_t mesh->self and set up the local sockets (listen only)
388 bool setup_myself(meshlink_handle_t *mesh) {
389 /* Set some defaults */
391 mesh->maxtimeout = 900;
395 mesh->self->nexthop = mesh->self;
396 mesh->self->status.reachable = true;
397 mesh->self->last_state_change = mesh->loop.now.tv_sec;
399 node_add(mesh, mesh->self);
403 if(!config_scan_all(mesh, "current", "hosts", load_node, NULL)) {
404 meshlink_errno = MESHLINK_ESTORAGE;
410 mesh->listen_sockets = 0;
412 if(!add_listen_address(mesh, NULL, NULL)) {
413 if(strcmp(mesh->myport, "0")) {
414 logger(mesh, MESHLINK_INFO, "Could not bind to port %s, asking OS to choose one for us", mesh->myport);
416 mesh->myport = strdup("0");
422 if(!add_listen_address(mesh, NULL, NULL)) {
430 if(!mesh->listen_sockets) {
431 logger(mesh, MESHLINK_ERROR, "Unable to create any listening socket!");
437 mesh->last_config_check = mesh->loop.now.tv_sec;
445 bool setup_network(meshlink_handle_t *mesh) {
446 init_connections(mesh);
447 init_submeshes(mesh);
452 if(!setup_myself(mesh)) {
460 close all open network connections
462 void close_network_connections(meshlink_handle_t *mesh) {
463 if(mesh->connections) {
464 for(list_node_t *node = mesh->connections->head, *next; node; node = next) {
466 connection_t *c = node->data;
468 terminate_connection(mesh, c, false);
472 for(int i = 0; i < mesh->listen_sockets; i++) {
473 io_del(&mesh->loop, &mesh->listen_socket[i].tcp);
474 io_del(&mesh->loop, &mesh->listen_socket[i].udp);
475 close(mesh->listen_socket[i].tcp.fd);
476 close(mesh->listen_socket[i].udp.fd);
482 exit_submeshes(mesh);
483 exit_connections(mesh);