2 netutl.c -- some supporting network utility code
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.
28 bool hostnames = false;
31 Turn a string into a struct addrinfo.
32 Return NULL on failure.
34 struct addrinfo *str2addrinfo(const char *address, const char *service, int socktype) {
38 struct addrinfo hint = {
39 .ai_family = addressfamily,
40 .ai_socktype = socktype,
43 err = getaddrinfo(address, service, &hint, &ai);
46 logger(NULL, MESHLINK_WARNING, "Error looking up %s port %s: %s", address, service, err == EAI_SYSTEM ? strerror(errno) : gai_strerror(err));
53 sockaddr_t str2sockaddr(const char *address, const char *port) {
58 memset(&result, 0, sizeof(result));
60 struct addrinfo hint = {
61 .ai_family = AF_UNSPEC,
62 .ai_flags = AI_NUMERICHOST,
63 .ai_socktype = SOCK_STREAM,
66 err = getaddrinfo(address, port, &hint, &ai);
69 logger(NULL, MESHLINK_DEBUG, "Unknown type address %s port %s", address, port);
70 result.sa.sa_family = AF_UNKNOWN;
71 result.unknown.address = xstrdup(address);
72 result.unknown.port = xstrdup(port);
76 memcpy(&result, ai->ai_addr, ai->ai_addrlen);
82 void sockaddr2str(const sockaddr_t *sa, char **addrstr, char **portstr) {
83 char address[NI_MAXHOST];
84 char port[NI_MAXSERV];
88 if(sa->sa.sa_family == AF_UNKNOWN) {
90 *addrstr = xstrdup(sa->unknown.address);
94 *portstr = xstrdup(sa->unknown.port);
100 err = getnameinfo(&sa->sa, SALEN(sa->sa), address, sizeof(address), port, sizeof(port), NI_NUMERICHOST | NI_NUMERICSERV);
103 logger(NULL, MESHLINK_ERROR, "Error while translating addresses: %s", err == EAI_SYSTEM ? strerror(errno) : gai_strerror(err));
107 scopeid = strchr(address, '%');
110 *scopeid = '\0'; /* Descope. */
114 *addrstr = xstrdup(address);
118 *portstr = xstrdup(port);
122 char *sockaddr2hostname(const sockaddr_t *sa) {
124 char address[NI_MAXHOST] = "unknown";
125 char port[NI_MAXSERV] = "unknown";
128 if(sa->sa.sa_family == AF_UNKNOWN) {
129 xasprintf(&str, "%s port %s", sa->unknown.address, sa->unknown.port);
133 err = getnameinfo(&sa->sa, SALEN(sa->sa), address, sizeof(address), port, sizeof(port),
134 hostnames ? 0 : (NI_NUMERICHOST | NI_NUMERICSERV));
137 logger(NULL, MESHLINK_ERROR, "Error while looking up hostname: %s", err == EAI_SYSTEM ? strerror(errno) : gai_strerror(err));
141 xasprintf(&str, "%s port %s", address, port);
146 int sockaddrcmp_noport(const sockaddr_t *a, const sockaddr_t *b) {
149 result = a->sa.sa_family - b->sa.sa_family;
155 switch(a->sa.sa_family) {
160 return strcmp(a->unknown.address, b->unknown.address);
163 return memcmp(&a->in.sin_addr, &b->in.sin_addr, sizeof(a->in.sin_addr));
166 return memcmp(&a->in6.sin6_addr, &b->in6.sin6_addr, sizeof(a->in6.sin6_addr));
169 logger(NULL, MESHLINK_ERROR, "sockaddrcmp() was called with unknown address family %d, exitting!",
175 int sockaddrcmp(const sockaddr_t *a, const sockaddr_t *b) {
178 result = a->sa.sa_family - b->sa.sa_family;
184 switch(a->sa.sa_family) {
189 result = strcmp(a->unknown.address, b->unknown.address);
195 return strcmp(a->unknown.port, b->unknown.port);
198 result = memcmp(&a->in.sin_addr, &b->in.sin_addr, sizeof(a)->in.sin_addr);
204 return memcmp(&a->in.sin_port, &b->in.sin_port, sizeof(a)->in.sin_port);
207 result = memcmp(&a->in6.sin6_addr, &b->in6.sin6_addr, sizeof(a)->in6.sin6_addr);
213 return memcmp(&a->in6.sin6_port, &b->in6.sin6_port, sizeof(a)->in6.sin6_port);
216 logger(NULL, MESHLINK_ERROR, "sockaddrcmp() was called with unknown address family %d, exitting!",
222 void sockaddrcpy(sockaddr_t *a, const sockaddr_t *b) {
223 if(b->sa.sa_family != AF_UNKNOWN) {
226 a->unknown.family = AF_UNKNOWN;
227 a->unknown.address = xstrdup(b->unknown.address);
228 a->unknown.port = xstrdup(b->unknown.port);
232 void sockaddrcpy_setport(sockaddr_t *a, const sockaddr_t *b, uint16_t port) {
235 switch(b->sa.sa_family) {
237 a->in.sin_port = htons(port);
241 a->in6.sin6_port = htons(port);
249 void sockaddrfree(sockaddr_t *a) {
250 if(a->sa.sa_family == AF_UNKNOWN) {
251 free(a->unknown.address);
252 free(a->unknown.port);
256 void sockaddrunmap(sockaddr_t *sa) {
257 if(sa->sa.sa_family == AF_INET6 && IN6_IS_ADDR_V4MAPPED(&sa->in6.sin6_addr)) {
258 sa->in.sin_addr.s_addr = ((uint32_t *) & sa->in6.sin6_addr)[3];
259 sa->in.sin_family = AF_INET;
263 void packmsg_add_sockaddr(packmsg_output_t *out, const sockaddr_t *sa) {
264 switch(sa->sa.sa_family) {
267 memcpy(buf + 0, &sa->in.sin_port, 2);
268 memcpy(buf + 2, &sa->in.sin_addr, 4);
269 packmsg_add_ext(out, 4, buf, sizeof(buf));
275 memcpy(buf + 0, &sa->in6.sin6_port, 2);
276 memcpy(buf + 2, &sa->in6.sin6_addr, 16);
277 packmsg_add_ext(out, 6, buf, sizeof(buf));
282 packmsg_output_invalidate(out);
287 sockaddr_t packmsg_get_sockaddr(packmsg_input_t *in) {
292 uint32_t len = packmsg_get_ext_raw(in, &type, &data);
297 packmsg_input_invalidate(in);
301 sa.sa.sa_family = AF_INET;
302 memcpy(&sa.in.sin_port, (uint8_t *)data + 0, 2);
303 memcpy(&sa.in.sin_addr, (uint8_t *)data + 2, 4);
308 packmsg_input_invalidate(in);
312 sa.sa.sa_family = AF_INET6;
313 memcpy(&sa.in6.sin6_port, (uint8_t *)data + 0, 2);
314 memcpy(&sa.in6.sin6_addr, (uint8_t *)data + 2, 16);
318 packmsg_input_invalidate(in);