git.meshlink.io Git - meshlink/blob - bsd/device.c

   1 /*
   2     device.c -- Interaction BSD tun/tap device
   3     Copyright (C) 2001-2005 Ivo Timmermans,
   4                   2001-2011 Guus Sliepen <guus@tinc-vpn.org>
   5                   2009      Grzegorz Dymarek <gregd72002@googlemail.com>
   6
   7     This program is free software; you can redistribute it and/or modify
   8     it under the terms of the GNU General Public License as published by
   9     the Free Software Foundation; either version 2 of the License, or
  10     (at your option) any later version.
  11
  12     This program is distributed in the hope that it will be useful,
  13     but WITHOUT ANY WARRANTY; without even the implied warranty of
  14     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15     GNU General Public License for more details.
  16
  17     You should have received a copy of the GNU General Public License along
  18     with this program; if not, write to the Free Software Foundation, Inc.,
  19     51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  20 */
  21
  22 #include "system.h"
  23
  24 #include "conf.h"
  25 #include "logger.h"
  26 #include "net.h"
  27 #include "route.h"
  28 #include "utils.h"
  29 #include "xalloc.h"
  30
  31 #ifdef HAVE_TUNEMU
  32 #include "bsd/tunemu.h"
  33 #endif
  34
  35 #define DEFAULT_DEVICE "/dev/tun0"
  36
  37 typedef enum device_type {
  38         DEVICE_TYPE_TUN,
  39         DEVICE_TYPE_TUNIFHEAD,
  40         DEVICE_TYPE_TAP,
  41 #ifdef HAVE_TUNEMU
  42         DEVICE_TYPE_TUNEMU,
  43 #endif
  44 } device_type_t;
  45
  46 int device_fd = -1;
  47 char *device = NULL;
  48 char *iface = NULL;
  49 static char *device_info = NULL;
  50 static uint64_t device_total_in = 0;
  51 static uint64_t device_total_out = 0;
  52 #if defined(TUNEMU)
  53 static device_type_t device_type = DEVICE_TYPE_TUNEMU;
  54 #elif defined(HAVE_OPENBSD) || defined(HAVE_FREEBSD) || defined(HAVE_DRAGONFLY)
  55 static device_type_t device_type = DEVICE_TYPE_TUNIFHEAD;
  56 #else
  57 static device_type_t device_type = DEVICE_TYPE_TUN;
  58 #endif
  59
  60 bool setup_device(void) {
  61         char *type;
  62
  63         if(!get_config_string(lookup_config(config_tree, "Device"), &device))
  64                 device = xstrdup(DEFAULT_DEVICE);
  65
  66         if(!get_config_string(lookup_config(config_tree, "Interface"), &iface))
  67                 iface = xstrdup(strrchr(device, '/') ? strrchr(device, '/') + 1 : device);
  68
  69         if(get_config_string(lookup_config(config_tree, "DeviceType"), &type)) {
  70                 if(!strcasecmp(type, "tun"))
  71                         /* use default */;
  72 #ifdef HAVE_TUNEMU
  73                 else if(!strcasecmp(type, "tunemu"))
  74                         device_type = DEVICE_TYPE_TUNEMU;
  75 #endif
  76                 else if(!strcasecmp(type, "tunnohead"))
  77                         device_type = DEVICE_TYPE_TUN;
  78                 else if(!strcasecmp(type, "tunifhead"))
  79                         device_type = DEVICE_TYPE_TUNIFHEAD;
  80                 else if(!strcasecmp(type, "tap"))
  81                         device_type = DEVICE_TYPE_TAP;
  82                 else {
  83                         logger(LOG_ERR, "Unknown device type %s!", type);
  84                         return false;
  85                 }
  86         } else {
  87                 if(strstr(device, "tap") || routing_mode != RMODE_ROUTER)
  88                         device_type = DEVICE_TYPE_TAP;
  89         }
  90
  91         switch(device_type) {
  92 #ifdef HAVE_TUNEMU
  93                 case DEVICE_TYPE_TUNEMU: {
  94                         char dynamic_name[256] = "";
  95                         device_fd = tunemu_open(dynamic_name);
  96                 }
  97                         break;
  98 #endif
  99                 default:
 100                         device_fd = open(device, O_RDWR | O_NONBLOCK);
 101         }
 102
 103         if(device_fd < 0) {
 104                 logger(LOG_ERR, "Could not open %s: %s", device, strerror(errno));
 105                 return false;
 106         }
 107
 108         switch(device_type) {
 109                 default:
 110                         device_type = DEVICE_TYPE_TUN;
 111                 case DEVICE_TYPE_TUN:
 112 #ifdef TUNSIFHEAD
 113                 {
 114                         const int zero = 0;
 115                         if(ioctl(device_fd, TUNSIFHEAD, &zero, sizeof zero) == -1) {
 116                                 logger(LOG_ERR, "System call `%s' failed: %s", "ioctl", strerror(errno));
 117                                 return false;
 118                         }
 119                 }
 120 #endif
 121 #if defined(TUNSIFMODE) && defined(IFF_BROADCAST) && defined(IFF_MULTICAST)
 122                 {
 123                         const int mode = IFF_BROADCAST | IFF_MULTICAST;
 124                         ioctl(device_fd, TUNSIFMODE, &mode, sizeof mode);
 125                 }
 126 #endif
 127
 128                         device_info = "Generic BSD tun device";
 129                         break;
 130                 case DEVICE_TYPE_TUNIFHEAD:
 131 #ifdef TUNSIFHEAD
 132                 {
 133                         const int one = 1;
 134                         if(ioctl(device_fd, TUNSIFHEAD, &one, sizeof one) == -1) {
 135                                 logger(LOG_ERR, "System call `%s' failed: %s", "ioctl", strerror(errno));
 136                                 return false;
 137                         }
 138                 }
 139 #endif
 140 #if defined(TUNSIFMODE) && defined(IFF_BROADCAST) && defined(IFF_MULTICAST)
 141                 {
 142                                 const int mode = IFF_BROADCAST | IFF_MULTICAST;
 143                                 ioctl(device_fd, TUNSIFMODE, &mode, sizeof mode);
 144                 }
 145 #endif
 146
 147                         device_info = "Generic BSD tun device";
 148                         break;
 149                 case DEVICE_TYPE_TAP:
 150                         if(routing_mode == RMODE_ROUTER)
 151                                 overwrite_mac = true;
 152                         device_info = "Generic BSD tap device";
 153 #ifdef TAPGIFNAME
 154                         {
 155                                 struct ifreq ifr;
 156                                 if(ioctl(device_fd, TAPGIFNAME, (void*)&ifr) == 0) {
 157                                         if(iface)
 158                                                 free(iface);
 159                                         iface = xstrdup(ifr.ifr_name);
 160                                 }
 161                         }
 162
 163 #endif
 164                         break;
 165 #ifdef HAVE_TUNEMU
 166                 case DEVICE_TYPE_TUNEMU:
 167                         device_info = "BSD tunemu device";
 168                         break;
 169 #endif
 170         }
 171
 172         logger(LOG_INFO, "%s is a %s", device, device_info);
 173
 174         return true;
 175 }
 176
 177 void close_device(void) {
 178         switch(device_type) {
 179 #ifdef HAVE_TUNEMU
 180                 case DEVICE_TYPE_TUNEMU:
 181                         tunemu_close(device_fd);
 182                         break;
 183 #endif
 184                 default:
 185                         close(device_fd);
 186         }
 187
 188         free(device);
 189         free(iface);
 190 }
 191
 192 bool read_packet(vpn_packet_t *packet) {
 193         int inlen;
 194
 195         switch(device_type) {
 196                 case DEVICE_TYPE_TUN:
 197 #ifdef HAVE_TUNEMU
 198                 case DEVICE_TYPE_TUNEMU:
 199                         if(device_type == DEVICE_TYPE_TUNEMU)
 200                                 inlen = tunemu_read(device_fd, packet->data + 14, MTU - 14);
 201                         else
 202 #endif
 203                                 inlen = read(device_fd, packet->data + 14, MTU - 14);
 204
 205                         if(inlen <= 0) {
 206                                 logger(LOG_ERR, "Error while reading from %s %s: %s", device_info,
 207                                            device, strerror(errno));
 208                                 return false;
 209                         }
 210
 211                         switch(packet->data[14] >> 4) {
 212                                 case 4:
 213                                         packet->data[12] = 0x08;
 214                                         packet->data[13] = 0x00;
 215                                         break;
 216                                 case 6:
 217                                         packet->data[12] = 0x86;
 218                                         packet->data[13] = 0xDD;
 219                                         break;
 220                                 default:
 221                                         ifdebug(TRAFFIC) logger(LOG_ERR,
 222                                                            "Unknown IP version %d while reading packet from %s %s",
 223                                                            packet->data[14] >> 4, device_info, device);
 224                                         return false;
 225                         }
 226
 227                         packet->len = inlen + 14;
 228                         break;
 229
 230                 case DEVICE_TYPE_TUNIFHEAD: {
 231                         u_int32_t type;
 232                         struct iovec vector[2] = {{&type, sizeof type}, {packet->data + 14, MTU - 14}};
 233
 234                         if((inlen = readv(device_fd, vector, 2)) <= 0) {
 235                                 logger(LOG_ERR, "Error while reading from %s %s: %s", device_info,
 236                                            device, strerror(errno));
 237                                 return false;
 238                         }
 239
 240                         switch (ntohl(type)) {
 241                                 case AF_INET:
 242                                         packet->data[12] = 0x08;
 243                                         packet->data[13] = 0x00;
 244                                         break;
 245
 246                                 case AF_INET6:
 247                                         packet->data[12] = 0x86;
 248                                         packet->data[13] = 0xDD;
 249                                         break;
 250
 251                                 default:
 252                                         ifdebug(TRAFFIC) logger(LOG_ERR,
 253                                                            "Unknown address family %x while reading packet from %s %s",
 254                                                            ntohl(type), device_info, device);
 255                                         return false;
 256                         }
 257
 258                         packet->len = inlen + 10;
 259                         break;
 260                 }
 261
 262                 case DEVICE_TYPE_TAP:
 263                         if((inlen = read(device_fd, packet->data, MTU)) <= 0) {
 264                                 logger(LOG_ERR, "Error while reading from %s %s: %s", device_info,
 265                                            device, strerror(errno));
 266                                 return false;
 267                         }
 268
 269                         packet->len = inlen;
 270                         break;
 271
 272                 default:
 273                         return false;
 274         }
 275
 276         device_total_in += packet->len;
 277
 278         ifdebug(TRAFFIC) logger(LOG_DEBUG, "Read packet of %d bytes from %s",
 279                            packet->len, device_info);
 280
 281         return true;
 282 }
 283
 284 bool write_packet(vpn_packet_t *packet) {
 285         ifdebug(TRAFFIC) logger(LOG_DEBUG, "Writing packet of %d bytes to %s",
 286                            packet->len, device_info);
 287
 288         switch(device_type) {
 289                 case DEVICE_TYPE_TUN:
 290                         if(write(device_fd, packet->data + 14, packet->len - 14) < 0) {
 291                                 logger(LOG_ERR, "Error while writing to %s %s: %s", device_info,
 292                                            device, strerror(errno));
 293                                 return false;
 294                         }
 295                         break;
 296
 297                 case DEVICE_TYPE_TUNIFHEAD: {
 298                         u_int32_t type;
 299                         struct iovec vector[2] = {{&type, sizeof type}, {packet->data + 14, packet->len - 14}};
 300                         int af;
 301
 302                         af = (packet->data[12] << 8) + packet->data[13];
 303
 304                         switch (af) {
 305                                 case 0x0800:
 306                                         type = htonl(AF_INET);
 307                                         break;
 308                                 case 0x86DD:
 309                                         type = htonl(AF_INET6);
 310                                         break;
 311                                 default:
 312                                         ifdebug(TRAFFIC) logger(LOG_ERR,
 313                                                            "Unknown address family %x while writing packet to %s %s",
 314                                                            af, device_info, device);
 315                                         return false;
 316                         }
 317
 318                         if(writev(device_fd, vector, 2) < 0) {
 319                                 logger(LOG_ERR, "Can't write to %s %s: %s", device_info, device,
 320                                            strerror(errno));
 321                                 return false;
 322                         }
 323                         break;
 324                 }
 325
 326                 case DEVICE_TYPE_TAP:
 327                         if(write(device_fd, packet->data, packet->len) < 0) {
 328                                 logger(LOG_ERR, "Error while writing to %s %s: %s", device_info,
 329                                            device, strerror(errno));
 330                                 return false;
 331                         }
 332                         break;
 333
 334 #ifdef HAVE_TUNEMU
 335                 case DEVICE_TYPE_TUNEMU:
 336                         if(tunemu_write(device_fd, packet->data + 14, packet->len - 14) < 0) {
 337                                 logger(LOG_ERR, "Error while writing to %s %s: %s", device_info,
 338                                            device, strerror(errno));
 339                                 return false;
 340                         }
 341                         break;
 342 #endif
 343
 344                 default:
 345                         return false;
 346         }
 347
 348         device_total_out += packet->len;
 349
 350         return true;
 351 }
 352
 353 void dump_device_stats(void) {
 354         logger(LOG_DEBUG, "Statistics for %s %s:", device_info, device);
 355         logger(LOG_DEBUG, " total bytes in:  %10"PRIu64, device_total_in);
 356         logger(LOG_DEBUG, " total bytes out: %10"PRIu64, device_total_out);
 357 }