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