8459673263c3afa27422012116b4c63f08fdeacd
[tinc] / src / netutl.c
1 /*
2     netutl.c -- some supporting network utility code
3     Copyright (C) 1998-2005 Ivo Timmermans
4                   2000-2009 Guus Sliepen <guus@tinc-vpn.org>
5
6     This program is free software; you can redistribute it and/or modify
7     it under the terms of the GNU General Public License as published by
8     the Free Software Foundation; either version 2 of the License, or
9     (at your option) any later version.
10
11     This program is distributed in the hope that it will be useful,
12     but WITHOUT ANY WARRANTY; without even the implied warranty of
13     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14     GNU General Public License for more details.
15
16     You should have received a copy of the GNU General Public License
17     along with this program; if not, write to the Free Software
18     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
19 */
20
21 #include "system.h"
22
23 #include "net.h"
24 #include "netutl.h"
25 #include "logger.h"
26 #include "utils.h"
27 #include "xalloc.h"
28
29 bool hostnames = false;
30
31 /*
32   Turn a string into a struct addrinfo.
33   Return NULL on failure.
34 */
35 struct addrinfo *str2addrinfo(const char *address, const char *service, int socktype)
36 {
37         struct addrinfo *ai, hint = {0};
38         int err;
39
40         cp();
41
42         hint.ai_family = addressfamily;
43         hint.ai_socktype = socktype;
44
45         err = getaddrinfo(address, service, &hint, &ai);
46
47         if(err) {
48                 logger(LOG_WARNING, _("Error looking up %s port %s: %s"), address,
49                                    service, gai_strerror(err));
50                 return NULL;
51         }
52
53         return ai;
54 }
55
56 sockaddr_t str2sockaddr(const char *address, const char *port)
57 {
58         struct addrinfo *ai, hint = {0};
59         sockaddr_t result;
60         int err;
61
62         cp();
63
64         hint.ai_family = AF_UNSPEC;
65         hint.ai_flags = AI_NUMERICHOST;
66         hint.ai_socktype = SOCK_STREAM;
67
68         err = getaddrinfo(address, port, &hint, &ai);
69
70         if(err || !ai) {
71                 ifdebug(SCARY_THINGS)
72                         logger(LOG_DEBUG, "Unknown type address %s port %s", address, port);
73                 result.sa.sa_family = AF_UNKNOWN;
74                 result.unknown.address = xstrdup(address);
75                 result.unknown.port = xstrdup(port);
76                 return result;
77         }
78
79         memcpy(&result, ai->ai_addr, ai->ai_addrlen);
80         freeaddrinfo(ai);
81
82         return result;
83 }
84
85 void sockaddr2str(const sockaddr_t *sa, char **addrstr, char **portstr)
86 {
87         char address[NI_MAXHOST];
88         char port[NI_MAXSERV];
89         char *scopeid;
90         int err;
91
92         cp();
93
94         if(sa->sa.sa_family == AF_UNKNOWN) {
95                 *addrstr = xstrdup(sa->unknown.address);
96                 *portstr = xstrdup(sa->unknown.port);
97                 return;
98         }
99
100         err = getnameinfo(&sa->sa, SALEN(sa->sa), address, sizeof(address), port, sizeof(port), NI_NUMERICHOST | NI_NUMERICSERV);
101
102         if(err) {
103                 logger(LOG_ERR, _("Error while translating addresses: %s"),
104                            gai_strerror(err));
105                 cp_trace();
106                 raise(SIGFPE);
107                 exit(0);
108         }
109
110         scopeid = strchr(address, '%');
111
112         if(scopeid)
113                 *scopeid = '\0';                /* Descope. */
114
115         *addrstr = xstrdup(address);
116         *portstr = xstrdup(port);
117 }
118
119 char *sockaddr2hostname(const sockaddr_t *sa)
120 {
121         char *str;
122         char address[NI_MAXHOST] = "unknown";
123         char port[NI_MAXSERV] = "unknown";
124         int err;
125
126         cp();
127
128         if(sa->sa.sa_family == AF_UNKNOWN) {
129                 xasprintf(&str, _("%s port %s"), sa->unknown.address, sa->unknown.port);
130                 return str;
131         }
132
133         err = getnameinfo(&sa->sa, SALEN(sa->sa), address, sizeof(address), port, sizeof(port),
134                                         hostnames ? 0 : (NI_NUMERICHOST | NI_NUMERICSERV));
135         if(err) {
136                 logger(LOG_ERR, _("Error while looking up hostname: %s"),
137                            gai_strerror(err));
138         }
139
140         xasprintf(&str, _("%s port %s"), address, port);
141
142         return str;
143 }
144
145 int sockaddrcmp_noport(const sockaddr_t *a, const sockaddr_t *b)
146 {
147         int result;
148
149         cp();
150
151         result = a->sa.sa_family - b->sa.sa_family;
152
153         if(result)
154                 return result;
155
156         switch (a->sa.sa_family) {
157                 case AF_UNSPEC:
158                         return 0;
159
160                 case AF_UNKNOWN:
161                         return strcmp(a->unknown.address, b->unknown.address);
162
163                 case AF_INET:
164                         return memcmp(&a->in.sin_addr, &b->in.sin_addr, sizeof(a->in.sin_addr));
165
166                 case AF_INET6:
167                         return memcmp(&a->in6.sin6_addr, &b->in6.sin6_addr, sizeof(a->in6.sin6_addr));
168
169                 default:
170                         logger(LOG_ERR, _("sockaddrcmp() was called with unknown address family %d, exitting!"),
171                                    a->sa.sa_family);
172                         cp_trace();
173                         raise(SIGFPE);
174                         exit(0);
175         }
176 }
177
178 int sockaddrcmp(const sockaddr_t *a, const sockaddr_t *b)
179 {
180         int result;
181
182         cp();
183
184         result = a->sa.sa_family - b->sa.sa_family;
185
186         if(result)
187                 return result;
188
189         switch (a->sa.sa_family) {
190                 case AF_UNSPEC:
191                         return 0;
192
193                 case AF_UNKNOWN:
194                         result = strcmp(a->unknown.address, b->unknown.address);
195
196                         if(result)
197                                 return result;
198
199                         return strcmp(a->unknown.port, b->unknown.port);
200
201                 case AF_INET:
202                         result = memcmp(&a->in.sin_addr, &b->in.sin_addr, sizeof(a->in.sin_addr));
203
204                         if(result)
205                                 return result;
206
207                         return memcmp(&a->in.sin_port, &b->in.sin_port, sizeof(a->in.sin_port));
208
209                 case AF_INET6:
210                         result = memcmp(&a->in6.sin6_addr, &b->in6.sin6_addr, sizeof(a->in6.sin6_addr));
211
212                         if(result)
213                                 return result;
214
215                         return memcmp(&a->in6.sin6_port, &b->in6.sin6_port, sizeof(a->in6.sin6_port));
216
217                 default:
218                         logger(LOG_ERR, _("sockaddrcmp() was called with unknown address family %d, exitting!"),
219                                    a->sa.sa_family);
220                         cp_trace();
221                         raise(SIGFPE);
222                         exit(0);
223         }
224 }
225
226 void sockaddrcpy(sockaddr_t *a, const sockaddr_t *b) {
227         cp();
228
229         if(b->sa.sa_family != AF_UNKNOWN) {
230                 *a = *b;
231         } else {
232                 a->unknown.family = AF_UNKNOWN;
233                 a->unknown.address = xstrdup(b->unknown.address);
234                 a->unknown.port = xstrdup(b->unknown.port);
235         }
236 }
237
238 void sockaddrfree(sockaddr_t *a) {
239         cp();
240
241         if(a->sa.sa_family == AF_UNKNOWN) {
242                 free(a->unknown.address);
243                 free(a->unknown.port);
244         }
245 }
246         
247 void sockaddrunmap(sockaddr_t *sa)
248 {
249         cp();
250
251         if(sa->sa.sa_family == AF_INET6 && IN6_IS_ADDR_V4MAPPED(&sa->in6.sin6_addr)) {
252                 sa->in.sin_addr.s_addr = ((uint32_t *) & sa->in6.sin6_addr)[3];
253                 sa->in.sin_family = AF_INET;
254         }
255 }
256
257 /* Subnet mask handling */
258
259 int maskcmp(const void *va, const void *vb, int masklen)
260 {
261         int i, m, result;
262         const char *a = va;
263         const char *b = vb;
264
265         cp();
266
267         for(m = masklen, i = 0; m >= 8; m -= 8, i++) {
268                 result = a[i] - b[i];
269                 if(result)
270                         return result;
271         }
272
273         if(m)
274                 return (a[i] & (0x100 - (1 << (8 - m)))) -
275                         (b[i] & (0x100 - (1 << (8 - m))));
276
277         return 0;
278 }
279
280 void mask(void *va, int masklen, int len)
281 {
282         int i;
283         char *a = va;
284
285         cp();
286
287         i = masklen / 8;
288         masklen %= 8;
289
290         if(masklen)
291                 a[i++] &= (0x100 - (1 << (8 - masklen)));
292
293         for(; i < len; i++)
294                 a[i] = 0;
295 }
296
297 void maskcpy(void *va, const void *vb, int masklen, int len)
298 {
299         int i, m;
300         char *a = va;
301         const char *b = vb;
302
303         cp();
304
305         for(m = masklen, i = 0; m >= 8; m -= 8, i++)
306                 a[i] = b[i];
307
308         if(m) {
309                 a[i] = b[i] & (0x100 - (1 << (8 - m)));
310                 i++;
311         }
312
313         for(; i < len; i++)
314                 a[i] = 0;
315 }
316
317 bool maskcheck(const void *va, int masklen, int len)
318 {
319         int i;
320         const char *a = va;
321
322         cp();
323
324         i = masklen / 8;
325         masklen %= 8;
326
327         if(masklen && a[i++] & (0xff >> masklen))
328                 return false;
329
330         for(; i < len; i++)
331                 if(a[i] != 0)
332                         return false;
333
334         return true;
335 }