git.meshlink.io Git - meshlink/blob - src/net_setup.c

   1 /*
   2     net_setup.c -- Setup.
   3     Copyright (C) 2014-2017 Guus Sliepen <guus@meshlink.io>
   4
   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.
   9
  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.
  14
  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.
  18 */
  19
  20 #include "system.h"
  21
  22 #include "conf.h"
  23 #include "connection.h"
  24 #include "ecdsa.h"
  25 #include "graph.h"
  26 #include "logger.h"
  27 #include "meshlink_internal.h"
  28 #include "net.h"
  29 #include "netutl.h"
  30 #include "packmsg.h"
  31 #include "protocol.h"
  32 #include "route.h"
  33 #include "utils.h"
  34 #include "xalloc.h"
  35 #include "submesh.h"
  36
  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)) {
  40                 return false;
  41         }
  42
  43         in->ptr = config->buf;
  44         in->len = config->len;
  45
  46         uint32_t version = packmsg_get_uint32(in);
  47
  48         if(version != MESHLINK_CONFIG_VERSION) {
  49                 logger(mesh, MESHLINK_ERROR, "Invalid config file for node %s", n->name);
  50                 config_free(config);
  51                 return false;
  52         }
  53
  54         const char *name;
  55         uint32_t len = packmsg_get_str_raw(in, &name);
  56
  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);
  59                 config_free(config);
  60                 return false;
  61         }
  62
  63         return true;
  64 }
  65
  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)) {
  69                 return true;
  70         }
  71
  72         config_t config;
  73         packmsg_input_t in;
  74
  75         if(!node_get_config(mesh, n, &config, &in)) {
  76                 return false;
  77         }
  78
  79         packmsg_skip_element(&in); /* submesh */
  80         packmsg_get_int32(&in); /* devclass */
  81         packmsg_get_bool(&in); /* blacklisted */
  82
  83         const void *key;
  84         uint32_t len = packmsg_get_bin_raw(&in, &key);
  85
  86         if(len != 32) {
  87                 config_free(&config);
  88                 return false;
  89         }
  90
  91         n->ecdsa = ecdsa_set_public_key(key);
  92
  93         // While we are at it, read known address information
  94         if(!n->canonical_address) {
  95                 n->canonical_address = packmsg_get_str_dup(&in);
  96
  97                 if(!*n->canonical_address) {
  98                         free(n->canonical_address);
  99                         n->canonical_address = NULL;
 100                 }
 101         } else {
 102                 packmsg_skip_element(&in);
 103         }
 104
 105         // Append any known addresses in the config file to the list we currently have
 106         uint32_t known_count = 0;
 107
 108         for(uint32_t i = 0; i < MAX_RECENT; i++) {
 109                 if(n->recent[i].sa.sa_family) {
 110                         known_count++;
 111                 }
 112         }
 113
 114         uint32_t count = packmsg_get_array(&in);
 115
 116         for(uint32_t i = 0; i < count; i++) {
 117                 if(i < MAX_RECENT - known_count) {
 118                         n->recent[i + known_count] = packmsg_get_sockaddr(&in);
 119                 } else {
 120                         packmsg_skip_element(&in);
 121                 }
 122         }
 123
 124         time_t last_reachable = packmsg_get_int64(&in);
 125         time_t last_unreachable = packmsg_get_int64(&in);
 126
 127         if(!n->last_reachable) {
 128                 n->last_reachable = last_reachable;
 129         }
 130
 131         if(!n->last_unreachable) {
 132                 n->last_unreachable = last_unreachable;
 133         }
 134
 135         config_free(&config);
 136         return true;
 137 }
 138
 139 /// Fill in node details from a config blob.
 140 bool node_read_from_config(meshlink_handle_t *mesh, node_t *n, const config_t *config) {
 141         if(n->canonical_address) {
 142                 return true;
 143         }
 144
 145         packmsg_input_t in = {config->buf, config->len};
 146         uint32_t version = packmsg_get_uint32(&in);
 147
 148         if(version != MESHLINK_CONFIG_VERSION) {
 149                 return false;
 150         }
 151
 152         char *name = packmsg_get_str_dup(&in);
 153
 154         if(!name) {
 155                 return false;
 156         }
 157
 158         if(n->name) {
 159                 if(strcmp(n->name, name)) {
 160                         free(name);
 161                         return false;
 162                 }
 163
 164                 free(name);
 165         } else {
 166                 n->name = name;
 167         }
 168
 169         char *submesh_name = packmsg_get_str_dup(&in);
 170
 171         if(!strcmp(submesh_name, CORE_MESH)) {
 172                 free(submesh_name);
 173                 n->submesh = NULL;
 174         } else {
 175                 n->submesh = lookup_or_create_submesh(mesh, submesh_name);
 176                 free(submesh_name);
 177
 178                 if(!n->submesh) {
 179                         return false;
 180                 }
 181         }
 182
 183         n->devclass = packmsg_get_int32(&in);
 184         n->status.blacklisted = packmsg_get_bool(&in);
 185         const void *key;
 186         uint32_t len = packmsg_get_bin_raw(&in, &key);
 187
 188         if(len) {
 189                 if(len != 32) {
 190                         return false;
 191                 }
 192
 193                 if(!ecdsa_active(n->ecdsa)) {
 194                         n->ecdsa = ecdsa_set_public_key(key);
 195                 }
 196         }
 197
 198         n->canonical_address = packmsg_get_str_dup(&in);
 199
 200         if(!*n->canonical_address) {
 201                 free(n->canonical_address);
 202                 n->canonical_address = NULL;
 203         }
 204
 205         uint32_t count = packmsg_get_array(&in);
 206
 207         for(uint32_t i = 0; i < count; i++) {
 208                 if(i < MAX_RECENT) {
 209                         n->recent[i] = packmsg_get_sockaddr(&in);
 210                 } else {
 211                         packmsg_skip_element(&in);
 212                 }
 213         }
 214
 215         n->last_reachable = packmsg_get_int64(&in);
 216         n->last_unreachable = packmsg_get_int64(&in);
 217
 218         return packmsg_done(&in);
 219 }
 220
 221 bool node_write_config(meshlink_handle_t *mesh, node_t *n) {
 222         if(!mesh->confbase) {
 223                 return true;
 224         }
 225
 226         uint8_t buf[4096];
 227         packmsg_output_t out = {buf, sizeof(buf)};
 228
 229         packmsg_add_uint32(&out, MESHLINK_CONFIG_VERSION);
 230         packmsg_add_str(&out, n->name);
 231         packmsg_add_str(&out, n->submesh ? n->submesh->name : CORE_MESH);
 232         packmsg_add_int32(&out, n->devclass);
 233         packmsg_add_bool(&out, n->status.blacklisted);
 234
 235         if(ecdsa_active(n->ecdsa)) {
 236                 packmsg_add_bin(&out, ecdsa_get_public_key(n->ecdsa), 32);
 237         } else {
 238                 packmsg_add_bin(&out, "", 0);
 239         }
 240
 241         packmsg_add_str(&out, n->canonical_address ? n->canonical_address : "");
 242
 243         uint32_t count = 0;
 244
 245         for(uint32_t i = 0; i < MAX_RECENT; i++) {
 246                 if(n->recent[i].sa.sa_family) {
 247                         count++;
 248                 } else {
 249                         break;
 250                 }
 251         }
 252
 253         packmsg_add_array(&out, count);
 254
 255         for(uint32_t i = 0; i < count; i++) {
 256                 packmsg_add_sockaddr(&out, &n->recent[i]);
 257         }
 258
 259         packmsg_add_int64(&out, n->last_reachable);
 260         packmsg_add_int64(&out, n->last_unreachable);
 261
 262         if(!packmsg_output_ok(&out)) {
 263                 meshlink_errno = MESHLINK_EINTERNAL;
 264                 return false;
 265         }
 266
 267         config_t config = {buf, packmsg_output_size(&out, buf)};
 268
 269         if(!config_write(mesh, "current", n->name, &config, mesh->config_key)) {
 270                 call_error_cb(mesh, MESHLINK_ESTORAGE);
 271                 return false;
 272         }
 273
 274         return true;
 275 }
 276
 277 static bool load_node(meshlink_handle_t *mesh, const char *name, void *priv) {
 278         (void)priv;
 279
 280         if(!check_id(name)) {
 281                 return true;
 282         }
 283
 284         node_t *n = lookup_node(mesh, name);
 285
 286         if(n) {
 287                 return true;
 288         }
 289
 290         n = new_node();
 291         n->name = xstrdup(name);
 292
 293         config_t config;
 294         packmsg_input_t in;
 295
 296         if(!node_get_config(mesh, n, &config, &in)) {
 297                 free_node(n);
 298                 return false;
 299         }
 300
 301         if(!node_read_from_config(mesh, n, &config)) {
 302                 logger(mesh, MESHLINK_ERROR, "Invalid config file for node %s", n->name);
 303                 config_free(&config);
 304                 free_node(n);
 305                 return false;
 306         }
 307
 308         config_free(&config);
 309
 310         node_add(mesh, n);
 311
 312         return true;
 313 }
 314
 315 int setup_tcp_listen_socket(meshlink_handle_t *mesh, const struct addrinfo *aip) {
 316         int nfd = socket(aip->ai_family, SOCK_STREAM, IPPROTO_TCP);
 317
 318         if(nfd == -1) {
 319                 return -1;
 320         }
 321
 322 #ifdef FD_CLOEXEC
 323         fcntl(nfd, F_SETFD, FD_CLOEXEC);
 324 #endif
 325
 326         int option = 1;
 327         setsockopt(nfd, SOL_SOCKET, SO_REUSEADDR, (void *)&option, sizeof(option));
 328
 329 #if defined(IPV6_V6ONLY)
 330
 331         if(aip->ai_family == AF_INET6) {
 332                 setsockopt(nfd, IPPROTO_IPV6, IPV6_V6ONLY, (void *)&option, sizeof(option));
 333         }
 334
 335 #else
 336 #warning IPV6_V6ONLY not defined
 337 #endif
 338
 339         if(bind(nfd, aip->ai_addr, aip->ai_addrlen)) {
 340                 closesocket(nfd);
 341                 return -1;
 342         }
 343
 344         if(listen(nfd, 3)) {
 345                 logger(mesh, MESHLINK_ERROR, "System call `%s' failed: %s", "listen", sockstrerror(sockerrno));
 346                 closesocket(nfd);
 347                 return -1;
 348         }
 349
 350         return nfd;
 351 }
 352
 353 int setup_udp_listen_socket(meshlink_handle_t *mesh, const struct addrinfo *aip) {
 354         int nfd = socket(aip->ai_family, SOCK_DGRAM, IPPROTO_UDP);
 355
 356         if(nfd == -1) {
 357                 return -1;
 358         }
 359
 360 #ifdef FD_CLOEXEC
 361         fcntl(nfd, F_SETFD, FD_CLOEXEC);
 362 #endif
 363
 364 #ifdef O_NONBLOCK
 365         int flags = fcntl(nfd, F_GETFL);
 366
 367         if(fcntl(nfd, F_SETFL, flags | O_NONBLOCK) < 0) {
 368                 closesocket(nfd);
 369                 logger(mesh, MESHLINK_ERROR, "System call `%s' failed: %s", "fcntl", strerror(errno));
 370                 return -1;
 371         }
 372
 373 #elif defined(WIN32)
 374         unsigned long arg = 1;
 375
 376         if(ioctlsocket(nfd, FIONBIO, &arg) != 0) {
 377                 closesocket(nfd);
 378                 logger(mesh, MESHLINK_ERROR, "Call to `%s' failed: %s", "ioctlsocket", sockstrerror(sockerrno));
 379                 return -1;
 380         }
 381
 382 #endif
 383
 384         int option = 1;
 385         setsockopt(nfd, SOL_SOCKET, SO_REUSEADDR, (void *)&option, sizeof(option));
 386         setsockopt(nfd, SOL_SOCKET, SO_BROADCAST, (void *)&option, sizeof(option));
 387
 388 #if defined(IPV6_V6ONLY)
 389
 390         if(aip->ai_family == AF_INET6) {
 391                 setsockopt(nfd, IPPROTO_IPV6, IPV6_V6ONLY, (void *)&option, sizeof(option));
 392         }
 393
 394 #endif
 395
 396 #if defined(IP_DONTFRAG) && !defined(IP_DONTFRAGMENT)
 397 #define IP_DONTFRAGMENT IP_DONTFRAG
 398 #endif
 399
 400 #if defined(IP_MTU_DISCOVER) && defined(IP_PMTUDISC_DO)
 401         option = IP_PMTUDISC_DO;
 402         setsockopt(nfd, IPPROTO_IP, IP_MTU_DISCOVER, (void *)&option, sizeof(option));
 403 #elif defined(IP_DONTFRAGMENT)
 404         option = 1;
 405         setsockopt(nfd, IPPROTO_IP, IP_DONTFRAGMENT, (void *)&option, sizeof(option));
 406 #endif
 407
 408         if(aip->ai_family == AF_INET6) {
 409 #if defined(IPV6_MTU_DISCOVER) && defined(IPV6_PMTUDISC_DO)
 410                 option = IPV6_PMTUDISC_DO;
 411                 setsockopt(nfd, IPPROTO_IPV6, IPV6_MTU_DISCOVER, (void *)&option, sizeof(option));
 412 #elif defined(IPV6_DONTFRAG)
 413                 option = 1;
 414                 setsockopt(nfd, IPPROTO_IPV6, IPV6_DONTFRAG, (void *)&option, sizeof(option));
 415 #endif
 416         }
 417
 418         if(bind(nfd, aip->ai_addr, aip->ai_addrlen)) {
 419                 closesocket(nfd);
 420                 return -1;
 421         }
 422
 423         return nfd;
 424 }
 425
 426 /*
 427   Add listening sockets.
 428 */
 429 static bool add_listen_sockets(meshlink_handle_t *mesh) {
 430         struct addrinfo *ai;
 431
 432         struct addrinfo hint = {
 433                 .ai_family = AF_UNSPEC,
 434                 .ai_socktype = SOCK_STREAM,
 435                 .ai_protocol = IPPROTO_TCP,
 436                 .ai_flags = AI_PASSIVE | AI_NUMERICSERV,
 437         };
 438
 439         int err = getaddrinfo(NULL, mesh->myport, &hint, &ai);
 440
 441         if(err || !ai) {
 442                 logger(mesh, MESHLINK_ERROR, "System call `%s' failed: %s", "getaddrinfo", err == EAI_SYSTEM ? strerror(err) : gai_strerror(err));
 443                 return false;
 444         }
 445
 446         bool success = false;
 447
 448         for(struct addrinfo *aip = ai; aip; aip = aip->ai_next) {
 449                 // Ignore duplicate addresses
 450                 bool found = false;
 451
 452                 for(int i = 0; i < mesh->listen_sockets; i++) {
 453                         if(!memcmp(&mesh->listen_socket[i].sa, aip->ai_addr, aip->ai_addrlen)) {
 454                                 found = true;
 455                                 break;
 456                         }
 457                 }
 458
 459                 if(found) {
 460                         continue;
 461                 }
 462
 463                 if(mesh->listen_sockets >= MAXSOCKETS) {
 464                         logger(mesh, MESHLINK_ERROR, "Too many listening sockets");
 465                         return false;
 466                 }
 467
 468                 /* Try to bind to TCP */
 469
 470                 int tcp_fd = setup_tcp_listen_socket(mesh, aip);
 471
 472                 if(tcp_fd == -1) {
 473                         if(errno == EADDRINUSE) {
 474                                 /* If this port is in use for any address family, avoid it. */
 475                                 success = false;
 476                                 break;
 477                         } else {
 478                                 continue;
 479                         }
 480                 }
 481
 482                 /* If TCP worked, then we require that UDP works as well. */
 483
 484                 int udp_fd = setup_udp_listen_socket(mesh, aip);
 485
 486                 if(udp_fd == -1) {
 487                         closesocket(tcp_fd);
 488                         success = false;
 489                         break;
 490                 }
 491
 492                 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);
 493                 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);
 494
 495                 if(mesh->log_level <= MESHLINK_INFO) {
 496                         char *hostname = sockaddr2hostname((sockaddr_t *) aip->ai_addr);
 497                         logger(mesh, MESHLINK_INFO, "Listening on %s", hostname);
 498                         free(hostname);
 499                 }
 500
 501                 memcpy(&mesh->listen_socket[mesh->listen_sockets].sa, aip->ai_addr, aip->ai_addrlen);
 502                 memcpy(&mesh->listen_socket[mesh->listen_sockets].broadcast_sa, aip->ai_addr, aip->ai_addrlen);
 503
 504                 if(aip->ai_family == AF_INET6) {
 505                         mesh->listen_socket[mesh->listen_sockets].broadcast_sa.in6.sin6_addr.s6_addr[0x0] = 0xff;
 506                         mesh->listen_socket[mesh->listen_sockets].broadcast_sa.in6.sin6_addr.s6_addr[0x1] = 0x02;
 507                         mesh->listen_socket[mesh->listen_sockets].broadcast_sa.in6.sin6_addr.s6_addr[0xf] = 0x01;
 508                 } else {
 509                         mesh->listen_socket[mesh->listen_sockets].broadcast_sa.in.sin_addr.s_addr = 0xffffffff;
 510                 }
 511
 512                 mesh->listen_sockets++;
 513                 success = true;
 514         }
 515
 516         freeaddrinfo(ai);
 517
 518         if(!success) {
 519                 for(int i = 0; i < mesh->listen_sockets; i++) {
 520                         io_del(&mesh->loop, &mesh->listen_socket[i].tcp);
 521                         io_del(&mesh->loop, &mesh->listen_socket[i].udp);
 522                         close(mesh->listen_socket[i].tcp.fd);
 523                         close(mesh->listen_socket[i].udp.fd);
 524                 }
 525
 526                 mesh->listen_sockets = 0;
 527         }
 528
 529         return success;
 530 }
 531
 532 /*
 533   Configure node_t mesh->self and set up the local sockets (listen only)
 534 */
 535 static bool setup_myself(meshlink_handle_t *mesh) {
 536         mesh->self->nexthop = mesh->self;
 537
 538         node_add(mesh, mesh->self);
 539
 540         if(!config_scan_all(mesh, "current", "hosts", load_node, NULL)) {
 541                 logger(mesh, MESHLINK_WARNING, "Could not scan all host config files");
 542         }
 543
 544         /* Open sockets */
 545
 546         mesh->listen_sockets = 0;
 547
 548         if(!add_listen_sockets(mesh)) {
 549                 if(strcmp(mesh->myport, "0")) {
 550                         logger(mesh, MESHLINK_WARNING, "Could not bind to port %s, trying to find an alternative port", mesh->myport);
 551
 552                         if(!check_port(mesh)) {
 553                                 logger(mesh, MESHLINK_WARNING, "Could not bind to any port, trying to bind to port 0");
 554                                 free(mesh->myport);
 555                                 mesh->myport = xstrdup("0");
 556                         }
 557
 558                         if(!add_listen_sockets(mesh)) {
 559                                 return false;
 560                         }
 561                 } else {
 562                         return false;
 563                 }
 564         }
 565
 566         if(!mesh->listen_sockets) {
 567                 logger(mesh, MESHLINK_ERROR, "Unable to create any listening socket!");
 568                 return false;
 569         }
 570
 571         /* Done. */
 572
 573         mesh->last_unreachable = mesh->loop.now.tv_sec;
 574
 575         return true;
 576 }
 577
 578 /*
 579   initialize network
 580 */
 581 bool setup_network(meshlink_handle_t *mesh) {
 582         init_connections(mesh);
 583         init_submeshes(mesh);
 584         init_nodes(mesh);
 585         init_edges(mesh);
 586         init_requests(mesh);
 587
 588         if(!setup_myself(mesh)) {
 589                 return false;
 590         }
 591
 592         return true;
 593 }
 594
 595 /*
 596   close all open network connections
 597 */
 598 void close_network_connections(meshlink_handle_t *mesh) {
 599         if(mesh->connections) {
 600                 for(list_node_t *node = mesh->connections->head, *next; node; node = next) {
 601                         next = node->next;
 602                         connection_t *c = node->data;
 603                         c->outgoing = NULL;
 604                         terminate_connection(mesh, c, false);
 605                 }
 606         }
 607
 608         for(int i = 0; i < mesh->listen_sockets; i++) {
 609                 io_del(&mesh->loop, &mesh->listen_socket[i].tcp);
 610                 io_del(&mesh->loop, &mesh->listen_socket[i].udp);
 611                 close(mesh->listen_socket[i].tcp.fd);
 612                 close(mesh->listen_socket[i].udp.fd);
 613         }
 614
 615         exit_requests(mesh);
 616         exit_edges(mesh);
 617         exit_nodes(mesh);
 618         exit_submeshes(mesh);
 619         exit_connections(mesh);
 620
 621         free(mesh->myport);
 622         mesh->myport = NULL;
 623
 624         mesh->self = NULL;
 625
 626         return;
 627 }