tun.c

   1 /*
   2  * OpenConnect (SSL + DTLS) VPN client
   3  *
   4  * Copyright © 2008-2010 Intel Corporation.
   5  *
   6  * Author: David Woodhouse <dwmw2@infradead.org>
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU Lesser General Public License
  10  * version 2.1, as published by the Free Software Foundation.
  11  *
  12  * This program is distributed in the hope that it will be useful, but
  13  * WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  15  * Lesser General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU Lesser General Public
  18  * License along with this library; if not, write to:
  19  *
  20  *   Free Software Foundation, Inc.
  21  *   51 Franklin Street, Fifth Floor,
  22  *   Boston, MA 02110-1301 USA
  23  */
  24
  25 #include <sys/types.h>
  26 #include <sys/stat.h>
  27 #include <sys/socket.h>
  28 #include <sys/ioctl.h>
  29 #include <string.h>
  30 #include <signal.h>
  31 #include <fcntl.h>
  32 #include <unistd.h>
  33 #include <netdb.h>
  34 #include <netinet/in_systm.h>
  35 #include <netinet/in.h>
  36 #include <netinet/ip.h>
  37 #include <net/if.h>
  38 #include <arpa/inet.h>
  39 #include <errno.h>
  40 #include <ctype.h>
  41 #if defined(__sun__)
  42 #include <stropts.h>
  43 #include <sys/sockio.h>
  44 #include <net/if_tun.h>
  45 #ifndef TUNNEWPPA
  46 #error "Install TAP driver from http://www.whiteboard.ne.jp/~admin2/tuntap/"
  47 #endif
  48 #endif
  49
  50 #include "openconnect-internal.h"
  51
  52 /*
  53  * If an if_tun.h include file was found anywhere (by the Makefile), it's
  54  * included. Else, we end up assuming that we have BSD-style devices such
  55  * as /dev/tun0 etc.
  56  */
  57 #ifdef IF_TUN_HDR
  58 #include IF_TUN_HDR
  59 #endif
  60
  61 /*
  62  * The OS X tun/tap driver doesn't provide a header file; you're expected
  63  * to define this for yourself.
  64  */
  65 #ifdef __APPLE__
  66 #define TUNSIFHEAD  _IOW('t', 96, int)
  67 #endif
  68
  69 /*
  70  * OpenBSD always puts the protocol family prefix onto packets. Other
  71  * systems let us enable that with the TUNSIFHEAD ioctl, and some of them
  72  * (e.g. FreeBSD) _need_ it otherwise they'll interpret IPv6 packets as IPv4.
  73  */
  74 #if defined(__OpenBSD__) || defined(TUNSIFHEAD)
  75 #define TUN_HAS_AF_PREFIX 1
  76 #endif
  77
  78 #ifdef __sun__
  79 static int local_config_tun(struct openconnect_info *vpninfo, int mtu_only)
  80 {
  81         if (!mtu_only)
  82                 vpn_progress(vpninfo, PRG_ERR,
  83                              _("No vpnc-script configured. Need Solaris IP-setting code\n"));
  84         return 0;
  85 }
  86 #else
  87 static int local_config_tun(struct openconnect_info *vpninfo, int mtu_only)
  88 {
  89         struct ifreq ifr;
  90         int net_fd;
  91
  92         net_fd = socket(PF_INET, SOCK_DGRAM, 0);
  93         if (net_fd < 0) {
  94                 perror(_("open net"));
  95                 return -EINVAL;
  96         }
  97         memset(&ifr, 0, sizeof(ifr));
  98         strncpy(ifr.ifr_name, vpninfo->ifname, sizeof(ifr.ifr_name) - 1);
  99
 100         if (!mtu_only) {
 101                 struct sockaddr_in addr;
 102
 103                 if (ioctl(net_fd, SIOCGIFFLAGS, &ifr) < 0)
 104                         perror(_("SIOCGIFFLAGS"));
 105
 106                 ifr.ifr_flags |= IFF_UP | IFF_POINTOPOINT;
 107                 if (ioctl(net_fd, SIOCSIFFLAGS, &ifr) < 0)
 108                         perror(_("SIOCSIFFLAGS"));
 109
 110                 addr.sin_family = AF_INET;
 111                 addr.sin_addr.s_addr = inet_addr(vpninfo->vpn_addr);
 112                 memcpy(&ifr.ifr_addr, &addr, sizeof(addr));
 113                 if (ioctl(net_fd, SIOCSIFADDR, &ifr) < 0)
 114                         perror(_("SIOCSIFADDR"));
 115         }
 116
 117         ifr.ifr_mtu = vpninfo->mtu;
 118         if (ioctl(net_fd, SIOCSIFMTU, &ifr) < 0)
 119                 perror(_("SIOCSIFMTU"));
 120
 121         close(net_fd);
 122
 123         return 0;
 124 }
 125 #endif
 126
 127 static int setenv_int(const char *opt, int value)
 128 {
 129         char buf[16];
 130         sprintf(buf, "%d", value);
 131         return setenv(opt, buf, 1);
 132 }
 133
 134 static int netmasklen(struct in_addr addr)
 135 {
 136         int masklen;
 137
 138         for (masklen = 0; masklen < 32; masklen++) {
 139                 if (ntohl(addr.s_addr) >= (0xffffffff << masklen))
 140                         break;
 141         }
 142         return 32 - masklen;
 143 }
 144
 145 static int process_split_xxclude(struct openconnect_info *vpninfo,
 146                                  int include, const char *route, int *v4_incs,
 147                                  int *v6_incs)
 148 {
 149         struct in_addr addr;
 150         const char *in_ex = include?"IN":"EX";
 151         char envname[80];
 152         char *slash;
 153
 154         slash = strchr(route, '/');
 155         if (!slash) {
 156         badinc:
 157                 if (include)
 158                         vpn_progress(vpninfo, PRG_ERR,
 159                                      _("Discard bad split include: \"%s\"\n"),
 160                                      route);
 161                 else
 162                         vpn_progress(vpninfo, PRG_ERR,
 163                                      _("Discard bad split exclude: \"%s\"\n"),
 164                                      route);
 165                 return -EINVAL;
 166         }
 167
 168         *slash = 0;
 169
 170         if (strchr(route, ':')) {
 171                 snprintf(envname, 79, "CISCO_IPV6_SPLIT_%sC_%d_ADDR", in_ex,
 172                          *v6_incs);
 173                 setenv(envname, route, 1);
 174
 175                 snprintf(envname, 79, "CISCO_IPV6_SPLIT_%sC_%d_MASKLEN", in_ex,
 176                          *v6_incs);
 177                 setenv(envname, slash+1, 1);
 178
 179                 (*v6_incs)++;
 180                 return 0;
 181         }
 182
 183         if (!inet_aton(route, &addr)) {
 184                 *slash = '/';
 185                 goto badinc;
 186         }
 187
 188         envname[79] = 0;
 189         snprintf(envname, 79, "CISCO_SPLIT_%sC_%d_ADDR", in_ex, *v4_incs);
 190         setenv(envname, route, 1);
 191
 192         /* Put it back how we found it */
 193         *slash = '/';
 194
 195         if (!inet_aton(slash+1, &addr))
 196                 goto badinc;
 197
 198         snprintf(envname, 79, "CISCO_SPLIT_%sC_%d_MASK", in_ex, *v4_incs);
 199         setenv(envname, slash+1, 1);
 200
 201         snprintf(envname, 79, "CISCO_SPLIT_%sC_%d_MASKLEN", in_ex, *v4_incs);
 202         setenv_int(envname, netmasklen(addr));
 203
 204         (*v4_incs)++;
 205         return 0;
 206 }
 207
 208 static int appendenv(const char *opt, const char *new)
 209 {
 210         char buf[1024];
 211         char *old = getenv(opt);
 212
 213         buf[1023] = 0;
 214         if (old)
 215                 snprintf(buf, 1023, "%s %s", old, new);
 216         else
 217                 snprintf(buf, 1023, "%s", new);
 218
 219         return setenv(opt, buf, 1);
 220 }
 221
 222 static void setenv_cstp_opts(struct openconnect_info *vpninfo)
 223 {
 224         char *env_buf;
 225         int buflen = 0;
 226         int bufofs = 0;
 227         struct vpn_option *opt;
 228
 229         for (opt = vpninfo->cstp_options; opt; opt = opt->next)
 230                 buflen += 2 + strlen(opt->option) + strlen(opt->value);
 231
 232         env_buf = malloc(buflen + 1);
 233         if (!env_buf)
 234                 return;
 235
 236         env_buf[buflen] = 0;
 237
 238         for (opt = vpninfo->cstp_options; opt; opt = opt->next)
 239                 bufofs += snprintf(env_buf + bufofs, buflen - bufofs,
 240                                    "%s=%s\n", opt->option, opt->value);
 241
 242         setenv("CISCO_CSTP_OPTIONS", env_buf, 1);
 243         free(env_buf);
 244 }
 245
 246 static void set_banner(struct openconnect_info *vpninfo)
 247 {
 248         char *banner, *q;
 249         const char *p;
 250
 251         if (!vpninfo->banner || !(banner = malloc(strlen(vpninfo->banner)))) {
 252                 unsetenv("CISCO_BANNER");
 253                 return;
 254         }
 255         p = vpninfo->banner;
 256         q = banner;
 257
 258         while (*p) {
 259                 if (*p == '%' && isxdigit((int)(unsigned char)p[1]) &&
 260                     isxdigit((int)(unsigned char)p[2])) {
 261                         *(q++) = unhex(p + 1);
 262                         p += 3;
 263                 } else
 264                         *(q++) = *(p++);
 265         }
 266         *q = 0;
 267         setenv("CISCO_BANNER", banner, 1);
 268
 269         free(banner);
 270 }
 271
 272 static void set_script_env(struct openconnect_info *vpninfo)
 273 {
 274         char host[80];
 275         int ret = getnameinfo(vpninfo->peer_addr, vpninfo->peer_addrlen, host,
 276                               sizeof(host), NULL, 0, NI_NUMERICHOST);
 277         if (!ret)
 278                 setenv("VPNGATEWAY", host, 1);
 279
 280         set_banner(vpninfo);
 281         unsetenv("CISCO_SPLIT_INC");
 282         unsetenv("CISCO_SPLIT_EXC");
 283
 284         setenv_int("INTERNAL_IP4_MTU", vpninfo->mtu);
 285
 286         if (vpninfo->vpn_addr) {
 287                 setenv("INTERNAL_IP4_ADDRESS", vpninfo->vpn_addr, 1);
 288                 if (vpninfo->vpn_netmask) {
 289                         struct in_addr addr;
 290                         struct in_addr mask;
 291
 292                         if (inet_aton(vpninfo->vpn_addr, &addr) &&
 293                             inet_aton(vpninfo->vpn_netmask, &mask)) {
 294                                 char *netaddr;
 295
 296                                 addr.s_addr &= mask.s_addr;
 297                                 netaddr = inet_ntoa(addr);
 298
 299                                 setenv("INTERNAL_IP4_NETADDR", netaddr, 1);
 300                                 setenv("INTERNAL_IP4_NETMASK", vpninfo->vpn_netmask, 1);
 301                                 setenv_int("INTERNAL_IP4_NETMASKLEN", netmasklen(mask));
 302                         }
 303                 }
 304         }
 305         if (vpninfo->vpn_addr6) {
 306                 setenv("INTERNAL_IP6_ADDRESS", vpninfo->vpn_addr6, 1);
 307                 setenv("INTERNAL_IP6_NETMASK", vpninfo->vpn_netmask6, 1);
 308         }
 309
 310         if (vpninfo->vpn_dns[0])
 311                 setenv("INTERNAL_IP4_DNS", vpninfo->vpn_dns[0], 1);
 312         else
 313                 unsetenv("INTERNAL_IP4_DNS");
 314         if (vpninfo->vpn_dns[1])
 315                 appendenv("INTERNAL_IP4_DNS", vpninfo->vpn_dns[1]);
 316         if (vpninfo->vpn_dns[2])
 317                 appendenv("INTERNAL_IP4_DNS", vpninfo->vpn_dns[2]);
 318
 319         if (vpninfo->vpn_nbns[0])
 320                 setenv("INTERNAL_IP4_NBNS", vpninfo->vpn_nbns[0], 1);
 321         else
 322                 unsetenv("INTERNAL_IP4_NBNS");
 323         if (vpninfo->vpn_nbns[1])
 324                 appendenv("INTERNAL_IP4_NBNS", vpninfo->vpn_nbns[1]);
 325         if (vpninfo->vpn_nbns[2])
 326                 appendenv("INTERNAL_IP4_NBNS", vpninfo->vpn_nbns[2]);
 327
 328         if (vpninfo->vpn_domain)
 329                 setenv("CISCO_DEF_DOMAIN", vpninfo->vpn_domain, 1);
 330         else unsetenv ("CISCO_DEF_DOMAIN");
 331
 332         if (vpninfo->vpn_proxy_pac)
 333                 setenv("CISCO_PROXY_PAC", vpninfo->vpn_proxy_pac, 1);
 334
 335         if (vpninfo->split_includes) {
 336                 struct split_include *this = vpninfo->split_includes;
 337                 int nr_split_includes = 0;
 338                 int nr_v6_split_includes = 0;
 339
 340                 while (this) {
 341                         process_split_xxclude(vpninfo, 1, this->route,
 342                                               &nr_split_includes,
 343                                               &nr_v6_split_includes);
 344                         this = this->next;
 345                 }
 346                 if (nr_split_includes)
 347                         setenv_int("CISCO_SPLIT_INC", nr_split_includes);
 348                 if (nr_v6_split_includes)
 349                         setenv_int("CISCO_IPV6_SPLIT_INC", nr_v6_split_includes);
 350         }
 351         if (vpninfo->split_excludes) {
 352                 struct split_include *this = vpninfo->split_excludes;
 353                 int nr_split_excludes = 0;
 354                 int nr_v6_split_excludes = 0;
 355
 356                 while (this) {
 357                         process_split_xxclude(vpninfo, 0, this->route,
 358                                               &nr_split_excludes,
 359                                               &nr_v6_split_excludes);
 360                         this = this->next;
 361                 }
 362                 if (nr_split_excludes)
 363                         setenv_int("CISCO_SPLIT_EXC", nr_split_excludes);
 364                 if (nr_v6_split_excludes)
 365                         setenv_int("CISCO_IPV6_SPLIT_EXC", nr_v6_split_excludes);
 366         }
 367         setenv_cstp_opts(vpninfo);
 368 }
 369
 370 int script_config_tun(struct openconnect_info *vpninfo, const char *reason)
 371 {
 372         if (!vpninfo->vpnc_script)
 373                 return 0;
 374
 375         setenv("reason", reason, 1);
 376         if (system(vpninfo->vpnc_script)) {
 377                 int e = errno;
 378                 vpn_progress(vpninfo, PRG_ERR,
 379                              _("Failed to spawn script '%s' for %s: %s\n"),
 380                              vpninfo->vpnc_script, reason, strerror(e));
 381                 return -e;
 382         }
 383         return 0;
 384 }
 385
 386 #ifdef __sun__
 387 static int link_proto(int unit_nr, const char *devname, uint64_t flags)
 388 {
 389         int ip_fd, mux_id, tun2_fd;
 390         struct lifreq ifr;
 391
 392         tun2_fd = open("/dev/tun", O_RDWR);
 393         if (tun2_fd < 0) {
 394                 perror(_("Could not /dev/tun for plumbing"));
 395                 return -EIO;
 396         }
 397         if (ioctl(tun2_fd, I_PUSH, "ip") < 0) {
 398                 perror(_("Can't push IP"));
 399                 close(tun2_fd);
 400                 return -EIO;
 401         }
 402
 403         sprintf(ifr.lifr_name, "tun%d", unit_nr);
 404         ifr.lifr_ppa = unit_nr;
 405         ifr.lifr_flags = flags;
 406
 407         if (ioctl(tun2_fd, SIOCSLIFNAME, &ifr) < 0) {
 408                 perror(_("Can't set ifname"));
 409                 close(tun2_fd);
 410                 return -1;
 411         }
 412
 413         ip_fd = open(devname, O_RDWR);
 414         if (ip_fd < 0) {
 415                 fprintf(stderr, _("Can't open %s: %s"), devname,
 416                         strerror(errno));
 417                 close(tun2_fd);
 418                 return -1;
 419         }
 420         if (ioctl(ip_fd, I_PUSH, "arp") < 0) {
 421                 perror(_("Can't push ARP"));
 422                 close(tun2_fd);
 423                 close(ip_fd);
 424                 return -1;
 425         }
 426
 427         mux_id = ioctl(ip_fd, I_LINK, tun2_fd);
 428         if (mux_id < 0) {
 429                 fprintf(stderr, _("Can't plumb %s for IPv%d: %s\n"),
 430                          ifr.lifr_name, (flags == IFF_IPV4) ? 4 : 6,
 431                          strerror(errno));
 432                 close(tun2_fd);
 433                 close(ip_fd);
 434                 return -1;
 435         }
 436
 437         close(tun2_fd);
 438
 439         return ip_fd;
 440 }
 441 #endif
 442
 443 static int os_setup_tun(struct openconnect_info *vpninfo)
 444 {
 445         int tun_fd;
 446
 447 #ifdef IFF_TUN /* Linux */
 448         struct ifreq ifr;
 449         int tunerr;
 450
 451         tun_fd = open("/dev/net/tun", O_RDWR);
 452         if (tun_fd < 0) {
 453                 /* Android has /dev/tun instead of /dev/net/tun
 454                    Since other systems might have too, just try it
 455                    as a fallback instead of using ifdef __ANDROID__ */
 456                 tunerr = errno;
 457                 tun_fd = open("/dev/tun", O_RDWR);
 458         }
 459         if (tun_fd < 0) {
 460                 /* If the error on /dev/tun is ENOENT, that's boring.
 461                    Use the error we got on /dev/net/tun instead */
 462                 if (errno != -ENOENT)
 463                         tunerr = errno;
 464
 465                 vpn_progress(vpninfo, PRG_ERR,
 466                              _("Failed to open tun device: %s\n"),
 467                              strerror(tunerr));
 468                 exit(1);
 469         }
 470         memset(&ifr, 0, sizeof(ifr));
 471         ifr.ifr_flags = IFF_TUN | IFF_NO_PI;
 472         if (vpninfo->ifname)
 473                 strncpy(ifr.ifr_name, vpninfo->ifname,
 474                         sizeof(ifr.ifr_name) - 1);
 475         if (ioctl(tun_fd, TUNSETIFF, (void *) &ifr) < 0) {
 476                 vpn_progress(vpninfo, PRG_ERR,
 477                              _("TUNSETIFF failed: %s\n"),
 478                              strerror(errno));
 479                 exit(1);
 480         }
 481         if (!vpninfo->ifname)
 482                 vpninfo->ifname = strdup(ifr.ifr_name);
 483 #elif defined (__sun__)
 484         static char tun_name[80];
 485         int unit_nr;
 486
 487         tun_fd = open("/dev/tun", O_RDWR);
 488         if (tun_fd < 0) {
 489                 perror(_("open /dev/tun"));
 490                 return -EIO;
 491         }
 492
 493         unit_nr = ioctl(tun_fd, TUNNEWPPA, -1);
 494         if (unit_nr < 0) {
 495                 perror(_("Failed to create new tun"));
 496                 close(tun_fd);
 497                 return -EIO;
 498         }
 499
 500         if (ioctl(tun_fd, I_SRDOPT, RMSGD) < 0) {
 501                 perror(_("Failed to put tun file descriptor into message-discard mode"));
 502                 close(tun_fd);
 503                 return -EIO;
 504         }
 505
 506         sprintf(tun_name, "tun%d", unit_nr);
 507         vpninfo->ifname = strdup(tun_name);
 508
 509         vpninfo->ip_fd = link_proto(unit_nr, "/dev/udp", IFF_IPV4);
 510         if (vpninfo->ip_fd < 0) {
 511                 close(tun_fd);
 512                 return -EIO;
 513         }
 514
 515         if (vpninfo->vpn_addr6) {
 516                 vpninfo->ip6_fd = link_proto(unit_nr, "/dev/udp6", IFF_IPV6);
 517                 if (vpninfo->ip6_fd < 0) {
 518                         close(tun_fd);
 519                         close(vpninfo->ip_fd);
 520                         vpninfo->ip_fd = -1;
 521                         return -EIO;
 522                 }
 523         } else
 524                 vpninfo->ip6_fd = -1;
 525
 526 #else /* BSD et al have /dev/tun$x devices */
 527         static char tun_name[80];
 528         int i;
 529         for (i = 0; i < 255; i++) {
 530                 sprintf(tun_name, "/dev/tun%d", i);
 531                 tun_fd = open(tun_name, O_RDWR);
 532                 if (tun_fd >= 0)
 533                         break;
 534         }
 535         if (tun_fd < 0) {
 536                 perror(_("open tun"));
 537                 exit(1);
 538         }
 539         vpninfo->ifname = strdup(tun_name + 5);
 540 #ifdef TUNSIFHEAD
 541         i = 1;
 542         if (ioctl(tun_fd, TUNSIFHEAD, &i) < 0) {
 543                 perror(_("TUNSIFHEAD"));
 544                 exit(1);
 545         }
 546 #endif
 547 #endif
 548         return tun_fd;
 549 }
 550
 551 /* Set up a tuntap device. */
 552 int setup_tun(struct openconnect_info *vpninfo)
 553 {
 554         int tun_fd;
 555
 556         set_script_env(vpninfo);
 557
 558         if (vpninfo->script_tun) {
 559                 pid_t child;
 560                 int fds[2];
 561
 562                 if (socketpair(AF_UNIX, SOCK_DGRAM, 0, fds)) {
 563                         perror(_("socketpair"));
 564                         exit(1);
 565                 }
 566                 tun_fd = fds[0];
 567                 child = fork();
 568                 if (child < 0) {
 569                         perror(_("fork"));
 570                         exit(1);
 571                 } else if (!child) {
 572                         close(tun_fd);
 573                         setenv_int("VPNFD", fds[1]);
 574                         execl("/bin/sh", "/bin/sh", "-c", vpninfo->vpnc_script, NULL);
 575                         perror(_("execl"));
 576                         exit(1);
 577                 }
 578                 close(fds[1]);
 579                 vpninfo->script_tun = child;
 580                 vpninfo->ifname = strdup(_("(script)"));
 581         } else {
 582                 script_config_tun(vpninfo, "pre-init");
 583
 584                 tun_fd = os_setup_tun(vpninfo);
 585                 if (tun_fd < 0)
 586                         return tun_fd;
 587
 588                 if (vpninfo->vpnc_script) {
 589                         setenv("TUNDEV", vpninfo->ifname, 1);
 590                         script_config_tun(vpninfo, "connect");
 591                         /* We have to set the MTU for ourselves, because the script doesn't */
 592                         local_config_tun(vpninfo, 1);
 593                 } else
 594                         local_config_tun(vpninfo, 0);
 595         }
 596
 597         fcntl(tun_fd, F_SETFD, FD_CLOEXEC);
 598
 599         vpninfo->tun_fd = tun_fd;
 600
 601         if (vpninfo->select_nfds <= tun_fd)
 602                 vpninfo->select_nfds = tun_fd + 1;
 603
 604         FD_SET(tun_fd, &vpninfo->select_rfds);
 605
 606         fcntl(vpninfo->tun_fd, F_SETFL, fcntl(vpninfo->tun_fd, F_GETFL) | O_NONBLOCK);
 607
 608         return 0;
 609 }
 610
 611 static struct pkt *out_pkt;
 612
 613 int tun_mainloop(struct openconnect_info *vpninfo, int *timeout)
 614 {
 615         int work_done = 0;
 616         int prefix_size = 0;
 617
 618 #ifdef TUN_HAS_AF_PREFIX
 619         if (!vpninfo->script_tun)
 620                 prefix_size = sizeof(int);
 621 #endif
 622
 623         if (FD_ISSET(vpninfo->tun_fd, &vpninfo->select_rfds)) {
 624                 while (1) {
 625                         int len = vpninfo->mtu;
 626
 627                         if (!out_pkt) {
 628                                 out_pkt = malloc(sizeof(struct pkt) + len);
 629                                 if (!out_pkt) {
 630                                         vpn_progress(vpninfo, PRG_ERR, "Allocation failed\n");
 631                                         break;
 632                                 }
 633                         }
 634
 635                         len = read(vpninfo->tun_fd, out_pkt->data - prefix_size, len + prefix_size);
 636                         if (len <= prefix_size)
 637                                 break;
 638                         out_pkt->len = len - prefix_size;
 639
 640                         queue_packet(&vpninfo->outgoing_queue, out_pkt);
 641                         out_pkt = NULL;
 642
 643                         work_done = 1;
 644                         vpninfo->outgoing_qlen++;
 645                         if (vpninfo->outgoing_qlen == vpninfo->max_qlen) {
 646                                 FD_CLR(vpninfo->tun_fd, &vpninfo->select_rfds);
 647                                 break;
 648                         }
 649                 }
 650         } else if (vpninfo->outgoing_qlen < vpninfo->max_qlen) {
 651                 FD_SET(vpninfo->tun_fd, &vpninfo->select_rfds);
 652         }
 653
 654         /* The kernel returns -ENOMEM when the queue is full, so theoretically
 655            we could handle that and retry... but it doesn't let us poll() for
 656            the no-longer-full situation, so let's not bother. */
 657         while (vpninfo->incoming_queue) {
 658                 struct pkt *this = vpninfo->incoming_queue;
 659                 unsigned char *data = this->data;
 660                 int len = this->len;
 661
 662 #ifdef TUN_HAS_AF_PREFIX
 663                 if (!vpninfo->script_tun) {
 664                         struct ip *iph = (void *)data;
 665                         int type;
 666
 667                         if (iph->ip_v == 6)
 668                                 type = AF_INET6;
 669                         else if (iph->ip_v == 4)
 670                                 type = AF_INET;
 671                         else {
 672                                 static int complained = 0;
 673                                 if (!complained) {
 674                                         complained = 1;
 675                                         vpn_progress(vpninfo, PRG_ERR,
 676                                                      _("Unknown packet (len %d) received: %02x %02x %02x %02x...\n"),
 677                                                      len, data[0], data[1], data[2], data[3]);
 678                                 }
 679                                 free(this);
 680                                 continue;
 681                         }
 682                         data -= 4;
 683                         len += 4;
 684                         *(int *)data = htonl(type);
 685                 }
 686 #endif
 687                 vpninfo->incoming_queue = this->next;
 688
 689                 if (write(vpninfo->tun_fd, data, len) < 0) {
 690                         /* Handle death of "script" socket */
 691                         if (vpninfo->script_tun && errno == ENOTCONN) {
 692                                 vpninfo->quit_reason = "Client connection terminated";
 693                                 return 1;
 694                         }
 695                         vpn_progress(vpninfo, PRG_ERR,
 696                                      _("Failed to write incoming packet: %s\n"),
 697                                      strerror(errno));
 698                 }
 699                 free(this);
 700         }
 701         /* Work is not done if we just got rid of packets off the queue */
 702         return work_done;
 703 }
 704
 705 void shutdown_tun(struct openconnect_info *vpninfo)
 706 {
 707         if (vpninfo->script_tun) {
 708                 kill(vpninfo->script_tun, SIGHUP);
 709         } else {
 710                 script_config_tun(vpninfo, "disconnect");
 711 #ifdef __sun__
 712                 close(vpninfo->ip_fd);
 713                 vpninfo->ip_fd = -1;
 714                 if (vpninfo->ip6_fd != -1) {
 715                         close(vpninfo->ip6_fd);
 716                         vpninfo->ip6_fd = -1;
 717                 }
 718 #endif
 719         }
 720
 721         close(vpninfo->tun_fd);
 722         vpninfo->tun_fd = -1;
 723 }