+ switch(nlm->nlmsg_type) {
+ case RTM_NEWLINK:
+ case RTM_DELLINK:
+ netlink_parse_link(mesh, nlm);
+ break;
+
+ case RTM_NEWADDR:
+ case RTM_DELADDR:
+ netlink_parse_addr(mesh, nlm);
+ }
+
+ ptr += nlm->nlmsg_len;
+ len -= nlm->nlmsg_len;
+ }
+}
+
+static void netlink_io_handler(event_loop_t *loop, void *data, int flags) {
+ (void)flags;
+ static time_t prev_update;
+ meshlink_handle_t *mesh = data;
+
+ struct {
+ struct nlmsghdr nlm;
+ char data[16384];
+ } msg;
+
+ while(true) {
+ ssize_t result = recv(mesh->pfroute_io.fd, &msg, sizeof(msg), MSG_DONTWAIT);
+
+ if(result <= 0) {
+ if(result == 0 || errno == EAGAIN || errno == EINTR) {
+ break;
+ }
+
+ logger(mesh, MESHLINK_ERROR, "Reading from Netlink socket failed: %s\n", strerror(errno));
+ io_set(loop, &mesh->pfroute_io, 0);
+ }
+
+ if((size_t)result < sizeof(msg.nlm)) {
+ logger(mesh, MESHLINK_ERROR, "Invalid Netlink message\n");
+ break;
+ }
+
+ if(msg.nlm.nlmsg_type == NLMSG_DONE) {
+ if(msg.nlm.nlmsg_seq == 1) {
+ // We just got the result of GETLINK, now send GETADDR.
+ netlink_getaddr(mesh->pfroute_io.fd);
+ }
+ } else {
+ netlink_parse(mesh, &msg, result);
+
+ if(loop->now.tv_sec > prev_update + 5) {
+ prev_update = loop->now.tv_sec;
+ handle_network_change(mesh, 1);
+ }
+ }
+ }
+}
+#elif defined(RTM_NEWADDR)
+static void pfroute_io_handler(event_loop_t *loop, void *data, int flags) {
+ (void)flags;
+ static time_t prev_update;
+ meshlink_handle_t *mesh = data;
+
+ struct {
+ struct rt_msghdr rtm;
+ char data[2048];
+ } msg;
+
+ while(true) {
+ msg.rtm.rtm_version = 0;
+ ssize_t result = recv(mesh->pfroute_io.fd, &msg, sizeof(msg), MSG_DONTWAIT);
+
+ if(result <= 0) {
+ if(result == 0 || errno == EAGAIN || errno == EINTR) {
+ break;
+ }
+
+ logger(mesh, MESHLINK_ERROR, "Reading from PFROUTE socket failed: %s\n", strerror(errno));
+ io_set(loop, &mesh->pfroute_io, 0);
+ }
+
+ if(msg.rtm.rtm_version != RTM_VERSION) {
+ logger(mesh, MESHLINK_ERROR, "Invalid PFROUTE message version\n");
+ break;
+ }
+
+ switch(msg.rtm.rtm_type) {
+ case RTM_IFINFO:
+ case RTM_NEWADDR:
+ case RTM_DELADDR:
+ if(loop->now.tv_sec > prev_update + 5) {
+ prev_update = loop->now.tv_sec;
+ handle_network_change(mesh, 1);
+ }
+
+ break;
+
+ default:
+ break;
+ }
+ }
+}
+#endif
+
+bool discovery_start(meshlink_handle_t *mesh) {
+ logger(mesh, MESHLINK_DEBUG, "discovery_start called\n");
+
+ assert(mesh);
+ assert(!mesh->catta_poll);
+ assert(!mesh->catta_server);
+ assert(!mesh->catta_browser);
+ assert(!mesh->discovery_threadstarted);
+ assert(!mesh->catta_servicetype);
+
+ if(pthread_mutex_lock(&mesh->discovery_mutex) != 0) {
+ abort();
+ }
+
+ // Start the discovery thread
+ if(pthread_create(&mesh->discovery_thread, NULL, discovery_loop, mesh) != 0) {
+ pthread_mutex_unlock(&mesh->discovery_mutex);
+ logger(mesh, MESHLINK_ERROR, "Could not start discovery thread: %s\n", strerror(errno));
+ memset(&mesh->discovery_thread, 0, sizeof(mesh)->discovery_thread);
+ return false;
+ }
+
+ pthread_cond_wait(&mesh->discovery_cond, &mesh->discovery_mutex);
+ pthread_mutex_unlock(&mesh->discovery_mutex);
+
+ mesh->discovery_threadstarted = true;
+
+#if defined(__linux)
+ int sock = socket(AF_NETLINK, SOCK_DGRAM, NETLINK_ROUTE);
+
+ if(sock != -1) {
+ struct sockaddr_nl sa;
+ memset(&sa, 0, sizeof(sa));
+ sa.nl_family = AF_NETLINK;
+ sa.nl_groups = RTMGRP_LINK | RTMGRP_IPV4_IFADDR | RTMGRP_IPV6_IFADDR;
+
+ if(bind(sock, (struct sockaddr *)&sa, sizeof(sa)) != -1) {
+ io_add(&mesh->loop, &mesh->pfroute_io, netlink_io_handler, mesh, sock, IO_READ);
+ netlink_getlink(sock);
+ } else {
+ logger(mesh, MESHLINK_WARNING, "Could not bind AF_NETLINK socket: %s", strerror(errno));
+ }
+ } else {
+ logger(mesh, MESHLINK_WARNING, "Could not open AF_NETLINK socket: %s", strerror(errno));
+ }
+
+#elif defined(RTM_NEWADDR)
+ int sock = socket(PF_ROUTE, SOCK_RAW, AF_UNSPEC);
+
+ if(sock != -1) {
+ io_add(&mesh->loop, &mesh->pfroute_io, pfroute_io_handler, mesh, sock, IO_READ);
+ } else {
+ logger(mesh, MESHLINK_WARNING, "Could not open PF_ROUTE socket: %s", strerror(errno));
+ }
+
+#endif
+
+ return true;
+}
+
+void discovery_stop(meshlink_handle_t *mesh) {
+ logger(mesh, MESHLINK_DEBUG, "discovery_stop called\n");
+
+ assert(mesh);
+
+ if(mesh->pfroute_io.cb) {
+ close(mesh->pfroute_io.fd);
+ io_del(&mesh->loop, &mesh->pfroute_io);
+ }
+
+ // Shut down
+ if(mesh->catta_poll) {
+ catta_simple_poll_quit(mesh->catta_poll);
+ }
+
+ // Wait for the discovery thread to finish
+ if(mesh->discovery_threadstarted == true) {
+ if(pthread_join(mesh->discovery_thread, NULL) != 0) {
+ abort();
+ }
+
+ mesh->discovery_threadstarted = false;
+ }