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