Cleanups:
[tinc] / src / netutl.c
1 /*
2     netutl.c -- some supporting network utility code
3     Copyright (C) 1998-2002 Ivo Timmermans <ivo@o2w.nl>
4                   2000-2002 Guus Sliepen <guus@sliepen.eu.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     $Id: netutl.c,v 1.12.4.42 2002/09/09 19:39:59 guus Exp $
21 */
22
23 #include "config.h"
24
25 #include <fcntl.h>
26 #include <netdb.h>
27 #include <netinet/in.h>
28 #include <stdio.h>
29 #include <stdlib.h>
30 #ifdef HAVE_INTTYPES_H
31  #include <inttypes.h>
32 #endif
33 #include <string.h>
34 #include <signal.h>
35 #include <sys/socket.h>
36 #include <syslog.h>
37 #include <arpa/inet.h>
38
39 #include <utils.h>
40 #include <xalloc.h>
41
42 #include "errno.h"
43 #include "conf.h"
44 #include "net.h"
45 #include "netutl.h"
46
47 #include "system.h"
48
49 int hostnames = 0;
50
51 /*
52   Turn a string into a struct addrinfo.
53   Return NULL on failure.
54 */
55 struct addrinfo *str2addrinfo(char *address, char *service, int socktype)
56 {
57   struct addrinfo hint, *ai;
58   int err;
59   cp();
60   memset(&hint, 0, sizeof(hint));
61
62   hint.ai_family = addressfamily;
63   hint.ai_socktype = socktype;
64
65   err = getaddrinfo(address, service, &hint, &ai);
66
67   if(err)
68     {
69       if(debug_lvl >= DEBUG_ERROR)
70         syslog(LOG_WARNING, _("Error looking up %s port %s: %s\n"), address, service, gai_strerror(err));
71       cp_trace();
72       return NULL;
73     }
74
75   cp();
76   return ai;
77 }
78
79 sockaddr_t str2sockaddr(char *address, char *port)
80 {
81   struct addrinfo hint, *ai;
82   sockaddr_t result;
83   int err;
84   cp();
85   memset(&hint, 0, sizeof(hint));
86
87   hint.ai_family = AF_UNSPEC;
88   hint.ai_flags = AI_NUMERICHOST;
89   hint.ai_socktype = SOCK_STREAM;
90
91   err = getaddrinfo(address, port, &hint, &ai);
92
93   if(err || !ai)
94     {
95       syslog(LOG_ERR, _("Error looking up %s port %s: %s\n"), address, port, gai_strerror(err));
96       cp_trace();
97       raise(SIGFPE);
98       exit(0);
99     }
100
101   result = *(sockaddr_t *)ai->ai_addr;
102   freeaddrinfo(ai);
103   cp();
104   return result;
105 }
106
107 void sockaddr2str(sockaddr_t *sa, char **addrstr, char **portstr)
108 {
109   char address[NI_MAXHOST];
110   char port[NI_MAXSERV];
111   char *scopeid;
112   int err;
113   cp();
114   err = getnameinfo(&sa->sa, SALEN(sa->sa), address, sizeof(address), port, sizeof(port), NI_NUMERICHOST|NI_NUMERICSERV);
115
116   if(err)
117     {
118       syslog(LOG_ERR, _("Error while translating addresses: %s"), gai_strerror(err));
119       cp_trace();
120       raise(SIGFPE);
121       exit(0);
122     }
123
124   scopeid = strchr(address, '%');
125
126   if(scopeid)
127     *scopeid = '\0';  /* Descope. */
128
129   *addrstr = xstrdup(address);
130   *portstr = xstrdup(port);
131   cp();
132 }
133
134 char *sockaddr2hostname(sockaddr_t *sa)
135 {
136   char *str;
137   char address[NI_MAXHOST] = "unknown";
138   char port[NI_MAXSERV] = "unknown";
139   int err;
140   cp();
141   err = getnameinfo(&sa->sa, SALEN(sa->sa), address, sizeof(address), port, sizeof(port), hostnames?0:(NI_NUMERICHOST|NI_NUMERICSERV));
142   if(err)
143     {
144       syslog(LOG_ERR, _("Error while looking up hostname: %s"), gai_strerror(err));
145     }
146
147   asprintf(&str, _("%s port %s"), address, port);
148   cp();
149   return str;
150 }
151
152 int sockaddrcmp(sockaddr_t *a, sockaddr_t *b)
153 {
154   int result;
155   cp();
156   result = a->sa.sa_family - b->sa.sa_family;
157   
158   if(result)
159     return result;
160   
161   switch(a->sa.sa_family)
162     {
163       case AF_UNSPEC:
164         return 0;
165       case AF_INET:
166         result = memcmp(&a->in.sin_addr, &b->in.sin_addr, sizeof(a->in.sin_addr));
167         if(result)
168           return result;
169         return memcmp(&a->in.sin_port, &b->in.sin_port, sizeof(a->in.sin_port));
170       case AF_INET6:
171         result = memcmp(&a->in6.sin6_addr, &b->in6.sin6_addr, sizeof(a->in6.sin6_addr));
172         if(result)
173           return result;
174         return memcmp(&a->in6.sin6_port, &b->in6.sin6_port, sizeof(a->in6.sin6_port));
175       default:
176         syslog(LOG_ERR, _("sockaddrcmp() was called with unknown address family %d, exitting!"), a->sa.sa_family);
177         cp_trace();
178         raise(SIGFPE);
179         exit(0);
180     }
181   cp();
182 }
183
184 void sockaddrunmap(sockaddr_t *sa)
185 {
186   if(sa->sa.sa_family == AF_INET6 && IN6_IS_ADDR_V4MAPPED(&sa->in6.sin6_addr))
187     {
188       sa->in.sin_addr.s_addr = ((uint32_t *)&sa->in6.sin6_addr)[3];
189       sa->in.sin_family = AF_INET;
190     }
191 }
192
193 /* Subnet mask handling */
194
195 int maskcmp(void *va, void *vb, int masklen, int len)
196 {
197   int i, m, result;
198   char *a = va;
199   char *b = vb;
200   cp();
201   for(m = masklen, i = 0; m >= 8; m -= 8, i++)
202     {
203       result = a[i] - b[i];
204       if(result)
205         return result;
206     }
207  
208   if(m)
209     return (a[i] & (0x100 - (1 << (8 - m)))) - (b[i] & (0x100 - (1 << (8 - m))));
210
211   return 0;
212 }
213
214 void mask(void *va, int masklen, int len)
215 {
216   int i;
217   char *a = va;
218   cp();
219   i = masklen / 8;
220   masklen %= 8;
221   
222   if(masklen)
223     a[i++] &= (0x100 - (1 << masklen));
224   
225   for(; i < len; i++)
226     a[i] = 0;
227 }
228
229 void maskcpy(void *va, void *vb, int masklen, int len)
230 {
231   int i, m;
232   char *a = va;
233   char *b = vb;
234   cp();
235   for(m = masklen, i = 0; m >= 8; m -= 8, i++)
236     a[i] = b[i];
237
238   if(m)
239     {
240       a[i] = b[i] & (0x100 - (1 << m));
241       i++;
242     }
243
244   for(; i < len; i++)
245     a[i] = 0;
246 }
247
248 int maskcheck(void *va, int masklen, int len)
249 {
250   int i;
251   char *a = va;
252   cp();
253   i = masklen / 8;
254   masklen %= 8;
255
256   if(masklen && a[i++] & (0xff >> masklen))
257     return -1;
258
259   for(; i < len; i++)
260     if(a[i] != 0)
261       return -2;
262
263   return 0;
264 }