Cleanup:
[tinc] / src / netutl.c
1 /*
2     netutl.c -- some supporting network utility code
3     Copyright (C) 1998-2002 Ivo Timmermans <itimmermans@bigfoot.com>
4                   2000-2002 Guus Sliepen <guus@sliepen.warande.net>
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.38 2002/06/08 12:57:10 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 #ifndef HAVE_STDINT_H
31  #include <stdint.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   if((err = getaddrinfo(address, service, &hint, &ai)))
66     {
67       if(debug_lvl >= DEBUG_ERROR)
68         syslog(LOG_WARNING, _("Error looking up %s port %s: %s\n"), address, service, gai_strerror(err));
69       cp_trace();
70       return NULL;
71     }
72
73 cp
74   return ai;
75 }
76
77 sockaddr_t str2sockaddr(char *address, char *port)
78 {
79   struct addrinfo hint, *ai;
80   sockaddr_t result;
81   int err;
82 cp
83   memset(&hint, 0, sizeof(hint));
84
85   hint.ai_family = AF_UNSPEC;
86   hint.ai_flags = AI_NUMERICHOST;
87   hint.ai_socktype = SOCK_STREAM;
88
89   if((err = getaddrinfo(address, port, &hint, &ai) || !ai))
90     {
91       syslog(LOG_ERR, _("Error looking up %s port %s: %s\n"), address, port, gai_strerror(err));
92       cp_trace();
93       raise(SIGFPE);
94       exit(0);
95     }
96
97   result = *(sockaddr_t *)ai->ai_addr;
98   freeaddrinfo(ai);
99 cp
100   return result;
101 }
102
103 void sockaddr2str(sockaddr_t *sa, char **addrstr, char **portstr)
104 {
105   char address[NI_MAXHOST];
106   char port[NI_MAXSERV];
107   char *scopeid;
108   int err;
109 cp
110   if((err = getnameinfo(&sa->sa, SALEN(sa->sa), address, sizeof(address), port, sizeof(port), NI_NUMERICHOST|NI_NUMERICSERV)))
111     {
112       syslog(LOG_ERR, _("Error while translating addresses: %s"), gai_strerror(err));
113       cp_trace();
114       raise(SIGFPE);
115       exit(0);
116     }
117
118   if((scopeid = strchr(address, '%')))
119     *scopeid = '\0';  /* Descope. */
120
121   *addrstr = xstrdup(address);
122   *portstr = xstrdup(port);
123 cp
124 }
125
126 char *sockaddr2hostname(sockaddr_t *sa)
127 {
128   char *str;
129   char address[NI_MAXHOST] = "unknown";
130   char port[NI_MAXSERV] = "unknown";
131   int err;
132 cp
133   if((err = getnameinfo(&sa->sa, SALEN(sa->sa), address, sizeof(address), port, sizeof(port), hostnames?0:(NI_NUMERICHOST|NI_NUMERICSERV))))
134     {
135       syslog(LOG_ERR, _("Error while looking up hostname: %s"), gai_strerror(err));
136     }
137
138   asprintf(&str, _("%s port %s"), address, port);
139 cp
140   return str;
141 }
142
143 int sockaddrcmp(sockaddr_t *a, sockaddr_t *b)
144 {
145   int result;
146 cp
147   result = a->sa.sa_family - b->sa.sa_family;
148   
149   if(result)
150     return result;
151   
152   switch(a->sa.sa_family)
153     {
154       case AF_UNSPEC:
155         return 0;
156       case AF_INET:
157         result = memcmp(&a->in.sin_addr, &b->in.sin_addr, sizeof(a->in.sin_addr));
158         if(result)
159           return result;
160         return memcmp(&a->in.sin_port, &b->in.sin_port, sizeof(a->in.sin_port));
161       case AF_INET6:
162         result = memcmp(&a->in6.sin6_addr, &b->in6.sin6_addr, sizeof(a->in6.sin6_addr));
163         if(result)
164           return result;
165         return memcmp(&a->in6.sin6_port, &b->in6.sin6_port, sizeof(a->in6.sin6_port));
166       default:
167         syslog(LOG_ERR, _("sockaddrcmp() was called with unknown address family %d, exitting!"), a->sa.sa_family);
168         cp_trace();
169         raise(SIGFPE);
170         exit(0);
171     }
172 cp
173 }
174
175 void sockaddrunmap(sockaddr_t *sa)
176 {
177   if(sa->sa.sa_family == AF_INET6 && IN6_IS_ADDR_V4MAPPED(&sa->in6.sin6_addr))
178     {
179       sa->in.sin_addr.s_addr = ((uint32_t *)&sa->in6.sin6_addr)[3];
180       sa->in.sin_family = AF_INET;
181     }
182 }
183
184 /* Subnet mask handling */
185
186 int maskcmp(void *va, void *vb, int masklen, int len)
187 {
188   int i, m, result;
189   char *a = va;
190   char *b = vb;
191 cp
192   for(m = masklen, i = 0; m >= 8; m -= 8, i++)
193     if((result = a[i] - b[i]))
194       return result;
195
196   if(m)
197     return (a[i] & (0x100 - (1 << (8 - m)))) - (b[i] & (0x100 - (1 << (8 - m))));
198
199   return 0;
200 }
201
202 void mask(void *va, int masklen, int len)
203 {
204   int i;
205   char *a = va;
206 cp
207   i = masklen / 8;
208   masklen %= 8;
209   
210   if(masklen)
211     a[i++] &= (0x100 - (1 << masklen));
212   
213   for(; i < len; i++)
214     a[i] = 0;
215 }
216
217 void maskcpy(void *va, void *vb, int masklen, int len)
218 {
219   int i, m;
220   char *a = va;
221   char *b = vb;
222 cp
223   for(m = masklen, i = 0; m >= 8; m -= 8, i++)
224     a[i] = b[i];
225
226   if(m)
227     {
228       a[i] = b[i] & (0x100 - (1 << m));
229       i++;
230     }
231
232   for(; i < len; i++)
233     a[i] = 0;
234 }
235
236 int maskcheck(void *va, int masklen, int len)
237 {
238   int i;
239   char *a = va;
240 cp
241   i = masklen / 8;
242   masklen %= 8;
243
244   if(a[i++] & (0xff >> masklen))
245     return -1;
246
247   for(; i < len; i++)
248     if(a[i] != 0)
249       return -2;
250
251   return 0;
252 }