/*
meshlink.c -- Implementation of the MeshLink API.
- Copyright (C) 2014 Guus Sliepen <guus@meshlink.io>
+ Copyright (C) 2014, 2017 Guus Sliepen <guus@meshlink.io>
This program is free software; you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
#define MSG_NOSIGNAL 0
#endif
-static pthread_mutex_t global_mutex;
-
__thread meshlink_errno_t meshlink_errno;
meshlink_log_cb_t global_log_cb;
meshlink_log_level_t global_log_level;
break;
case 1:
+ mesh->thedatalen = 0;
return finalize_join(mesh);
case 2:
logger(mesh, MESHLINK_DEBUG, "Done.\n");
snprintf(privname, sizeof privname, "%s" SLASH "ecdsa_key.priv", mesh->confbase);
- f = fopen(privname, "w");
+ f = fopen(privname, "wb");
if(!f) {
meshlink_errno = MESHLINK_ESTORAGE;
return true;
}
+static struct timeval idle(event_loop_t *loop, void *data) {
+ meshlink_handle_t *mesh = data;
+ struct timeval t, tmin = {3600, 0};
+ for splay_each(node_t, n, mesh->nodes) {
+ if(!n->utcp)
+ continue;
+ t = utcp_timeout(n->utcp);
+ if(timercmp(&t, &tmin, <))
+ tmin = t;
+ }
+ return tmin;
+}
+
+// Find out what local address a socket would use if we connect to the given address.
+// We do this using connect() on a UDP socket, so the kernel has to resolve the address
+// of both endpoints, but this will actually not send any UDP packet.
+static bool getlocaladdrname(char *destaddr, char *host, socklen_t hostlen) {
+ struct addrinfo *rai = NULL;
+ const struct addrinfo hint = {
+ .ai_family = AF_UNSPEC,
+ .ai_socktype = SOCK_DGRAM,
+ .ai_protocol = IPPROTO_UDP,
+ };
+
+ if(getaddrinfo(destaddr, "80", &hint, &rai) || !rai)
+ return false;
+
+ int sock = socket(rai->ai_family, rai->ai_socktype, rai->ai_protocol);
+ if(sock == -1) {
+ freeaddrinfo(rai);
+ return false;
+ }
+
+ if(connect(sock, rai->ai_addr, rai->ai_addrlen) && !sockwouldblock(errno)) {
+ freeaddrinfo(rai);
+ return false;
+ }
+
+ freeaddrinfo(rai);
+
+ struct sockaddr_storage sn;
+ socklen_t sl = sizeof sn;
+
+ if(getsockname(sock, (struct sockaddr *)&sn, &sl))
+ return false;
+
+ if(getnameinfo((struct sockaddr *)&sn, sl, host, hostlen, NULL, 0, NI_NUMERICHOST | NI_NUMERICSERV))
+ return false;
+
+ return true;
+}
+
+// Get our local address(es) by simulating connecting to an Internet host.
+static void add_local_addresses(meshlink_handle_t *mesh) {
+ char host[NI_MAXHOST];
+ char entry[MAX_STRING_SIZE];
+
+ // IPv4 example.org
+
+ if(getlocaladdrname("93.184.216.34", host, sizeof host)) {
+ snprintf(entry, sizeof entry, "%s %s", host, mesh->myport);
+ append_config_file(mesh, mesh->name, "Address", entry);
+ }
+
+ // IPv6 example.org
+
+ if(getlocaladdrname("2606:2800:220:1:248:1893:25c8:1946", host, sizeof host)) {
+ snprintf(entry, sizeof entry, "%s %s", host, mesh->myport);
+ append_config_file(mesh, mesh->name, "Address", entry);
+ }
+}
+
static bool meshlink_setup(meshlink_handle_t *mesh) {
if(mkdir(mesh->confbase, 0777) && errno != EEXIST) {
logger(mesh, MESHLINK_DEBUG, "Could not create directory %s: %s\n", mesh->confbase, strerror(errno));
}
meshlink_handle_t *meshlink_open(const char *confbase, const char *name, const char* appname, dev_class_t devclass) {
- return meshlink_open_with_size(confbase, name, appname, devclass, sizeof(meshlink_handle_t));
-}
-
-meshlink_handle_t *meshlink_open_with_size(const char *confbase, const char *name, const char* appname, dev_class_t devclass, size_t size) {
-
// Validate arguments provided by the application
bool usingname = false;
return NULL;
}
- meshlink_handle_t *mesh = xzalloc(size);
+ meshlink_handle_t *mesh = xzalloc(sizeof(meshlink_handle_t));
mesh->confbase = xstrdup(confbase);
mesh->appname = xstrdup(appname);
mesh->devclass = devclass;
return NULL;
}
+ add_local_addresses(mesh);
+
+ idle_set(&mesh->loop, idle, mesh);
+
logger(NULL, MESHLINK_DEBUG, "meshlink_open returning\n");
return mesh;
}
logger(mesh, MESHLINK_DEBUG, "meshlink_start called\n");
+ mesh->thedatalen = 0;
+
// TODO: open listening sockets first
//Check that a valid name is set
return;
}
+ // stop can be called even if mesh has not been started
+ meshlink_stop(mesh);
+
// lock is not released after this
pthread_mutex_lock(&(mesh->mesh_mutex));
}
bool meshlink_send(meshlink_handle_t *mesh, meshlink_node_t *destination, const void *data, size_t len) {
- if(!mesh || !destination) {
+ meshlink_packethdr_t *hdr;
+
+ // Validate arguments
+ if(!mesh || !destination || len >= MAXSIZE - sizeof *hdr) {
meshlink_errno = MESHLINK_EINVAL;
return false;
}
return false;
}
- pthread_mutex_lock(&(mesh->mesh_mutex));
+ // Prepare the packet
+ vpn_packet_t *packet = malloc(sizeof *packet);
+ if(!packet) {
+ meshlink_errno = MESHLINK_ENOMEM;
+ return false;
+ }
- //add packet to the queue
- outpacketqueue_t *packet_in_queue = xzalloc(sizeof *packet_in_queue);
- packet_in_queue->destination=destination;
- packet_in_queue->data=data;
- packet_in_queue->len=len;
- if(!meshlink_queue_push(&mesh->outpacketqueue, packet_in_queue)) {
- free(packet_in_queue);
- pthread_mutex_unlock(&(mesh->mesh_mutex));
+ packet->probe = false;
+ packet->tcp = false;
+ packet->len = len + sizeof *hdr;
+
+ hdr = (meshlink_packethdr_t *)packet->data;
+ memset(hdr, 0, sizeof *hdr);
+ // leave the last byte as 0 to make sure strings are always
+ // null-terminated if they are longer than the buffer
+ strncpy(hdr->destination, destination->name, (sizeof hdr->destination) - 1);
+ strncpy(hdr->source, mesh->self->name, (sizeof hdr->source) -1 );
+
+ memcpy(packet->data + sizeof *hdr, data, len);
+
+ // Queue it
+ if(!meshlink_queue_push(&mesh->outpacketqueue, packet)) {
+ free(packet);
+ meshlink_errno = MESHLINK_ENOMEM;
return false;
}
- //notify event loop
+ // Notify event loop
signal_trigger(&(mesh->loop),&(mesh->datafromapp));
- pthread_mutex_unlock(&(mesh->mesh_mutex));
return true;
}
-void meshlink_send_from_queue(event_loop_t* el,meshlink_handle_t *mesh) {
- pthread_mutex_lock(&(mesh->mesh_mutex));
-
- vpn_packet_t packet;
- meshlink_packethdr_t *hdr = (meshlink_packethdr_t *)packet.data;
-
- outpacketqueue_t* p = meshlink_queue_pop(&mesh->outpacketqueue);
- if(!p)
- {
- pthread_mutex_unlock(&(mesh->mesh_mutex));
- return;
- }
-
- if (sizeof(meshlink_packethdr_t) + p->len > MAXSIZE) {
- pthread_mutex_unlock(&(mesh->mesh_mutex));
- //log something
+void meshlink_send_from_queue(event_loop_t *loop, meshlink_handle_t *mesh) {
+ vpn_packet_t *packet = meshlink_queue_pop(&mesh->outpacketqueue);
+ if(!packet)
return;
- }
-
- packet.probe = false;
- memset(hdr, 0, sizeof *hdr);
- memcpy(hdr->destination, p->destination->name, sizeof hdr->destination);
- memcpy(hdr->source, mesh->self->name, sizeof hdr->source);
-
- packet.len = sizeof *hdr + p->len;
- memcpy(packet.data + sizeof *hdr, p->data, p->len);
- mesh->self->in_packets++;
- mesh->self->in_bytes += packet.len;
- route(mesh, mesh->self, &packet);
-
- pthread_mutex_unlock(&(mesh->mesh_mutex));
- return ;
+ mesh->self->in_packets++;
+ mesh->self->in_bytes += packet->len;
+ route(mesh, mesh->self, packet);
}
ssize_t meshlink_get_pmtu(meshlink_handle_t *mesh, meshlink_node_t *destination) {
}
// Create a new key if necessary.
- FILE *f = fopen(filename, "r");
+ FILE *f = fopen(filename, "rb");
if(!f) {
if(errno != ENOENT) {
logger(mesh, MESHLINK_DEBUG, "Could not read %s: %s\n", filename, strerror(errno));
pthread_mutex_unlock(&(mesh->mesh_mutex));
return false;
}
- f = fopen(filename, "w");
+ f = fopen(filename, "wb");
if(!f) {
logger(mesh, MESHLINK_DEBUG, "Could not write %s: %s\n", filename, strerror(errno));
meshlink_errno = MESHLINK_ESTORAGE;
fclose(f);
buf[len - 1] = 0;
- pthread_mutex_lock(&(mesh->mesh_mutex));
+ pthread_mutex_unlock(&(mesh->mesh_mutex));
return buf;
}
return;
}
+void meshlink_set_default_blacklist(meshlink_handle_t *mesh, bool blacklist) {
+ mesh->default_blacklist = blacklist;
+}
+
/* Hint that a hostname may be found at an address
* See header file for detailed comment.
*/
void meshlink_hint_address(meshlink_handle_t *mesh, meshlink_node_t *node, const struct sockaddr *addr) {
if(!mesh || !node || !addr)
return;
+
+ // Ignore hints about ourself.
+ if((node_t *)node == mesh->self)
+ return;
pthread_mutex_lock(&(mesh->mesh_mutex));
if(host && port) {
xasprintf(&str, "%s %s", host, port);
- append_config_file(mesh, node->name, "Address", str);
+ if ( (strncmp ("fe80",host,4) != 0) && ( strncmp("127.",host,4) != 0 ) && ( strcmp("localhost",host) !=0 ) )
+ append_config_file(mesh, node->name, "Address", str);
+ else
+ logger(mesh, MESHLINK_DEBUG, "Not adding Link Local IPv6 Address to config\n");
}
free(str);
return result;
}
+static bool channel_pre_accept(struct utcp *utcp, uint16_t port) {
+ //TODO: implement
+ return true;
+}
+
+static ssize_t channel_recv(struct utcp_connection *connection, const void *data, size_t len) {
+ meshlink_channel_t *channel = connection->priv;
+ if(!channel)
+ abort();
+ node_t *n = channel->node;
+ meshlink_handle_t *mesh = n->mesh;
+ if(!channel->receive_cb)
+ return -1;
+ else {
+ channel->receive_cb(mesh, channel, data, len);
+ return len;
+ }
+}
+
+static void channel_accept(struct utcp_connection *utcp_connection, uint16_t port) {
+ node_t *n = utcp_connection->utcp->priv;
+ if(!n)
+ abort();
+ meshlink_handle_t *mesh = n->mesh;
+ if(!mesh->channel_accept_cb)
+ return;
+ meshlink_channel_t *channel = xzalloc(sizeof *channel);
+ channel->node = n;
+ channel->c = utcp_connection;
+ if(mesh->channel_accept_cb(mesh, channel, port, NULL, 0))
+ utcp_accept(utcp_connection, channel_recv, channel);
+ else
+ free(channel);
+}
+
+static ssize_t channel_send(struct utcp *utcp, const void *data, size_t len) {
+ node_t *n = utcp->priv;
+ meshlink_handle_t *mesh = n->mesh;
+ char hex[len * 2 + 1];
+ bin2hex(data, hex, len);
+ logger(mesh, MESHLINK_WARNING, "channel_send(%p, %p, %zu): %s\n", utcp, data, len, hex);
+ return meshlink_send(mesh, (meshlink_node_t *)n, data, len) ? len : -1;
+}
+
+void meshlink_set_channel_receive_cb(meshlink_handle_t *mesh, meshlink_channel_t *channel, meshlink_channel_receive_cb_t cb) {
+ if(!mesh || !channel) {
+ meshlink_errno = MESHLINK_EINVAL;
+ return;
+ }
+
+ channel->receive_cb = cb;
+}
+
+static void channel_receive(meshlink_handle_t *mesh, meshlink_node_t *source, const void *data, size_t len) {
+ node_t *n = (node_t *)source;
+ if(!n->utcp)
+ abort();
+ char hex[len * 2 + 1];
+ bin2hex(data, hex, len);
+ logger(mesh, MESHLINK_WARNING, "channel_receive(%p, %p, %zu): %s\n", n->utcp, data, len, hex);
+ utcp_recv(n->utcp, data, len);
+}
+
+static void channel_poll(struct utcp_connection *connection, size_t len) {
+ meshlink_channel_t *channel = connection->priv;
+ if(!channel)
+ abort();
+ node_t *n = channel->node;
+ meshlink_handle_t *mesh = n->mesh;
+ if(channel->poll_cb)
+ channel->poll_cb(mesh, channel, len);
+}
+
+void meshlink_set_channel_poll_cb(meshlink_handle_t *mesh, meshlink_channel_t *channel, meshlink_channel_poll_cb_t cb) {
+ channel->poll_cb = cb;
+ utcp_set_poll_cb(channel->c, cb ? channel_poll : NULL);
+}
+
+void meshlink_set_channel_accept_cb(meshlink_handle_t *mesh, meshlink_channel_accept_cb_t cb) {
+ if(!mesh) {
+ meshlink_errno = MESHLINK_EINVAL;
+ return;
+ }
+
+ pthread_mutex_lock(&mesh->mesh_mutex);
+ mesh->channel_accept_cb = cb;
+ mesh->receive_cb = channel_receive;
+ for splay_each(node_t, n, mesh->nodes) {
+ if(!n->utcp && n != mesh->self) {
+ logger(mesh, MESHLINK_WARNING, "utcp_init on node %s", n->name);
+ n->utcp = utcp_init(channel_accept, channel_pre_accept, channel_send, n);
+ }
+ }
+ pthread_mutex_unlock(&mesh->mesh_mutex);
+}
+
+meshlink_channel_t *meshlink_channel_open(meshlink_handle_t *mesh, meshlink_node_t *node, uint16_t port, meshlink_channel_receive_cb_t cb, const void *data, size_t len) {
+ if(!mesh || !node) {
+ meshlink_errno = MESHLINK_EINVAL;
+ return NULL;
+ }
+
+ logger(mesh, MESHLINK_WARNING, "meshlink_channel_open(%p, %s, %u, %p, %p, %zu)\n", mesh, node->name, port, cb, data, len);
+ node_t *n = (node_t *)node;
+ if(!n->utcp) {
+ n->utcp = utcp_init(channel_accept, channel_pre_accept, channel_send, n);
+ mesh->receive_cb = channel_receive;
+ if(!n->utcp) {
+ meshlink_errno = errno == ENOMEM ? MESHLINK_ENOMEM : MESHLINK_EINTERNAL;
+ return NULL;
+ }
+ }
+ meshlink_channel_t *channel = xzalloc(sizeof *channel);
+ channel->node = n;
+ channel->receive_cb = cb;
+ channel->c = utcp_connect(n->utcp, port, channel_recv, channel);
+ if(!channel->c) {
+ meshlink_errno = errno == ENOMEM ? MESHLINK_ENOMEM : MESHLINK_EINTERNAL;
+ free(channel);
+ return NULL;
+ }
+ return channel;
+}
+
+void meshlink_channel_shutdown(meshlink_handle_t *mesh, meshlink_channel_t *channel, int direction) {
+ if(!mesh || !channel) {
+ meshlink_errno = MESHLINK_EINVAL;
+ return;
+ }
+
+ utcp_shutdown(channel->c, direction);
+}
+
+void meshlink_channel_close(meshlink_handle_t *mesh, meshlink_channel_t *channel) {
+ if(!mesh || !channel) {
+ meshlink_errno = MESHLINK_EINVAL;
+ return;
+ }
+
+ utcp_close(channel->c);
+ free(channel);
+}
+
+ssize_t meshlink_channel_send(meshlink_handle_t *mesh, meshlink_channel_t *channel, const void *data, size_t len) {
+ if(!mesh || !channel) {
+ meshlink_errno = MESHLINK_EINVAL;
+ return -1;
+ }
+
+ if(!len)
+ return 0;
+
+ if(!data) {
+ meshlink_errno = MESHLINK_EINVAL;
+ return -1;
+ }
+
+ // TODO: more finegrained locking.
+ // Ideally we want to put the data into the UTCP connection's send buffer.
+ // Then, preferrably only if there is room in the receiver window,
+ // kick the meshlink thread to go send packets.
+
+ pthread_mutex_lock(&mesh->mesh_mutex);
+ ssize_t retval = utcp_send(channel->c, data, len);
+ pthread_mutex_unlock(&mesh->mesh_mutex);
+
+ if(retval < 0)
+ meshlink_errno = MESHLINK_ENETWORK;
+ return retval;
+}
+
+void update_node_status(meshlink_handle_t *mesh, node_t *n) {
+ if(n->status.reachable && mesh->channel_accept_cb && !n->utcp)
+ n->utcp = utcp_init(channel_accept, channel_pre_accept, channel_send, n);
+ if(mesh->node_status_cb)
+ mesh->node_status_cb(mesh, (meshlink_node_t *)n, n->status.reachable);
+}
+
static void __attribute__((constructor)) meshlink_init(void) {
crypto_init();
}
crypto_exit();
}
-
/// Device class traits
dev_class_traits_t dev_class_traits[_DEV_CLASS_MAX +1] = {
{ .min_connects = 3, .max_connects = 10000, .edge_weight = 1 }, // DEV_CLASS_BACKBONE