openssh/misc.c

   1 /* $OpenBSD: misc.c,v 1.71 2009/02/21 19:32:04 tobias Exp $ */
   2 /*
   3  * Copyright (c) 2000 Markus Friedl.  All rights reserved.
   4  * Copyright (c) 2005,2006 Damien Miller.  All rights reserved.
   5  *
   6  * Redistribution and use in source and binary forms, with or without
   7  * modification, are permitted provided that the following conditions
   8  * are met:
   9  * 1. Redistributions of source code must retain the above copyright
  10  *    notice, this list of conditions and the following disclaimer.
  11  * 2. Redistributions in binary form must reproduce the above copyright
  12  *    notice, this list of conditions and the following disclaimer in the
  13  *    documentation and/or other materials provided with the distribution.
  14  *
  15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  17  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  18  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  19  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  20  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  21  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  22  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  23  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  24  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  25  */
  26
  27 #include "includes.h"
  28
  29 #include <sys/types.h>
  30 #include <sys/ioctl.h>
  31 #include <sys/socket.h>
  32 #include <sys/param.h>
  33
  34 #include <stdarg.h>
  35 #include <stdio.h>
  36 #include <stdlib.h>
  37 #include <string.h>
  38 #include <unistd.h>
  39
  40 #include <netinet/in.h>
  41 #include <netinet/tcp.h>
  42
  43 #include <errno.h>
  44 #include <fcntl.h>
  45 #include <netdb.h>
  46 #ifdef HAVE_PATHS_H
  47 # include <paths.h>
  48 #include <pwd.h>
  49 #endif
  50 #ifdef SSH_TUN_OPENBSD
  51 #include <net/if.h>
  52 #endif
  53
  54 #include "xmalloc.h"
  55 #include "misc.h"
  56 #include "log.h"
  57 #include "ssh.h"
  58
  59 /* remove newline at end of string */
  60 char *
  61 chop(char *s)
  62 {
  63         char *t = s;
  64         while (*t) {
  65                 if (*t == '\n' || *t == '\r') {
  66                         *t = '\0';
  67                         return s;
  68                 }
  69                 t++;
  70         }
  71         return s;
  72
  73 }
  74
  75 /* set/unset filedescriptor to non-blocking */
  76 int
  77 set_nonblock(int fd)
  78 {
  79         int val;
  80
  81         val = fcntl(fd, F_GETFL, 0);
  82         if (val < 0) {
  83                 error("fcntl(%d, F_GETFL, 0): %s", fd, strerror(errno));
  84                 return (-1);
  85         }
  86         if (val & O_NONBLOCK) {
  87                 debug3("fd %d is O_NONBLOCK", fd);
  88                 return (0);
  89         }
  90         debug2("fd %d setting O_NONBLOCK", fd);
  91         val |= O_NONBLOCK;
  92         if (fcntl(fd, F_SETFL, val) == -1) {
  93                 debug("fcntl(%d, F_SETFL, O_NONBLOCK): %s", fd,
  94                     strerror(errno));
  95                 return (-1);
  96         }
  97         return (0);
  98 }
  99
 100 int
 101 unset_nonblock(int fd)
 102 {
 103         int val;
 104
 105         val = fcntl(fd, F_GETFL, 0);
 106         if (val < 0) {
 107                 error("fcntl(%d, F_GETFL, 0): %s", fd, strerror(errno));
 108                 return (-1);
 109         }
 110         if (!(val & O_NONBLOCK)) {
 111                 debug3("fd %d is not O_NONBLOCK", fd);
 112                 return (0);
 113         }
 114         debug("fd %d clearing O_NONBLOCK", fd);
 115         val &= ~O_NONBLOCK;
 116         if (fcntl(fd, F_SETFL, val) == -1) {
 117                 debug("fcntl(%d, F_SETFL, ~O_NONBLOCK): %s",
 118                     fd, strerror(errno));
 119                 return (-1);
 120         }
 121         return (0);
 122 }
 123
 124 const char *
 125 ssh_gai_strerror(int gaierr)
 126 {
 127         if (gaierr == EAI_SYSTEM)
 128                 return strerror(errno);
 129         return gai_strerror(gaierr);
 130 }
 131
 132 /* disable nagle on socket */
 133 void
 134 set_nodelay(int fd)
 135 {
 136         int opt;
 137         socklen_t optlen;
 138
 139         optlen = sizeof opt;
 140         if (getsockopt(fd, IPPROTO_TCP, TCP_NODELAY, &opt, &optlen) == -1) {
 141                 debug("getsockopt TCP_NODELAY: %.100s", strerror(errno));
 142                 return;
 143         }
 144         if (opt == 1) {
 145                 debug2("fd %d is TCP_NODELAY", fd);
 146                 return;
 147         }
 148         opt = 1;
 149         debug2("fd %d setting TCP_NODELAY", fd);
 150         if (setsockopt(fd, IPPROTO_TCP, TCP_NODELAY, &opt, sizeof opt) == -1)
 151                 error("setsockopt TCP_NODELAY: %.100s", strerror(errno));
 152 }
 153
 154 /* Characters considered whitespace in strsep calls. */
 155 #define WHITESPACE " \t\r\n"
 156 #define QUOTE   "\""
 157
 158 /* Characters considered as quotations. */
 159 #define QUOTES "'\""
 160
 161 /* return next token in configuration line */
 162 char *
 163 strdelim(char **s)
 164 {
 165         char *old, *p, *q;
 166         int wspace = 0;
 167
 168         if (*s == NULL)
 169                 return NULL;
 170
 171         old = *s;
 172
 173         if ((q=strchr(QUOTES, (int) *old)) && *q)
 174         {
 175             /* find next quote character, point old to start of quoted
 176              * string */
 177             for (p = ++old;*p && *p!=*q; p++)
 178                  ;
 179
 180             /* find start of next token */
 181             *s = (*p) ? p + strspn(p + 1, WHITESPACE) + 1 : NULL;
 182
 183             /* terminate 'old' token */
 184             *p = '\0';
 185             return (old);
 186         }
 187
 188         *s = strpbrk(*s, WHITESPACE QUOTE "=");
 189         if (*s == NULL)
 190                 return (old);
 191
 192         if (*s[0] == '\"') {
 193                 memmove(*s, *s + 1, strlen(*s)); /* move nul too */
 194                 /* Find matching quote */
 195                 if ((*s = strpbrk(*s, QUOTE)) == NULL) {
 196                         return (NULL);          /* no matching quote */
 197                 } else {
 198                         *s[0] = '\0';
 199                         return (old);
 200                 }
 201         }
 202
 203         /* Allow only one '=' to be skipped */
 204         if (*s[0] == '=')
 205                 wspace = 1;
 206         *s[0] = '\0';
 207
 208         /* Skip any extra whitespace after first token */
 209         *s += strspn(*s + 1, WHITESPACE) + 1;
 210         if (*s[0] == '=' && !wspace)
 211                 *s += strspn(*s + 1, WHITESPACE) + 1;
 212
 213         return (old);
 214 }
 215
 216 struct passwd *
 217 pwcopy(struct passwd *pw)
 218 {
 219         struct passwd *copy = xcalloc(1, sizeof(*copy));
 220
 221         copy->pw_name = xstrdup(pw->pw_name);
 222         copy->pw_passwd = xstrdup(pw->pw_passwd);
 223         copy->pw_gecos = xstrdup(pw->pw_gecos);
 224         copy->pw_uid = pw->pw_uid;
 225         copy->pw_gid = pw->pw_gid;
 226 #ifdef HAVE_PW_EXPIRE_IN_PASSWD
 227         copy->pw_expire = pw->pw_expire;
 228 #endif
 229 #ifdef HAVE_PW_CHANGE_IN_PASSWD
 230         copy->pw_change = pw->pw_change;
 231 #endif
 232 #ifdef HAVE_PW_CLASS_IN_PASSWD
 233         copy->pw_class = xstrdup(pw->pw_class);
 234 #endif
 235         copy->pw_dir = xstrdup(pw->pw_dir);
 236         copy->pw_shell = xstrdup(pw->pw_shell);
 237         return copy;
 238 }
 239
 240 /*
 241  * Convert ASCII string to TCP/IP port number.
 242  * Port must be >=0 and <=65535.
 243  * Return -1 if invalid.
 244  */
 245 int
 246 a2port(const char *s)
 247 {
 248         long long port;
 249         const char *errstr;
 250
 251         port = strtonum(s, 0, 65535, &errstr);
 252         if (errstr != NULL)
 253                 return -1;
 254         return (int)port;
 255 }
 256
 257 int
 258 a2tun(const char *s, int *remote)
 259 {
 260         const char *errstr = NULL;
 261         char *sp, *ep;
 262         int tun;
 263
 264         if (remote != NULL) {
 265                 *remote = SSH_TUNID_ANY;
 266                 sp = xstrdup(s);
 267                 if ((ep = strchr(sp, ':')) == NULL) {
 268                         xfree(sp);
 269                         return (a2tun(s, NULL));
 270                 }
 271                 ep[0] = '\0'; ep++;
 272                 *remote = a2tun(ep, NULL);
 273                 tun = a2tun(sp, NULL);
 274                 xfree(sp);
 275                 return (*remote == SSH_TUNID_ERR ? *remote : tun);
 276         }
 277
 278         if (strcasecmp(s, "any") == 0)
 279                 return (SSH_TUNID_ANY);
 280
 281         tun = strtonum(s, 0, SSH_TUNID_MAX, &errstr);
 282         if (errstr != NULL)
 283                 return (SSH_TUNID_ERR);
 284
 285         return (tun);
 286 }
 287
 288 #define SECONDS         1
 289 #define MINUTES         (SECONDS * 60)
 290 #define HOURS           (MINUTES * 60)
 291 #define DAYS            (HOURS * 24)
 292 #define WEEKS           (DAYS * 7)
 293
 294 /*
 295  * Convert a time string into seconds; format is
 296  * a sequence of:
 297  *      time[qualifier]
 298  *
 299  * Valid time qualifiers are:
 300  *      <none>  seconds
 301  *      s|S     seconds
 302  *      m|M     minutes
 303  *      h|H     hours
 304  *      d|D     days
 305  *      w|W     weeks
 306  *
 307  * Examples:
 308  *      90m     90 minutes
 309  *      1h30m   90 minutes
 310  *      2d      2 days
 311  *      1w      1 week
 312  *
 313  * Return -1 if time string is invalid.
 314  */
 315 long
 316 convtime(const char *s)
 317 {
 318         long total, secs;
 319         const char *p;
 320         char *endp;
 321
 322         errno = 0;
 323         total = 0;
 324         p = s;
 325
 326         if (p == NULL || *p == '\0')
 327                 return -1;
 328
 329         while (*p) {
 330                 secs = strtol(p, &endp, 10);
 331                 if (p == endp ||
 332                     (errno == ERANGE && (secs == LONG_MIN || secs == LONG_MAX)) ||
 333                     secs < 0)
 334                         return -1;
 335
 336                 switch (*endp++) {
 337                 case '\0':
 338                         endp--;
 339                         break;
 340                 case 's':
 341                 case 'S':
 342                         break;
 343                 case 'm':
 344                 case 'M':
 345                         secs *= MINUTES;
 346                         break;
 347                 case 'h':
 348                 case 'H':
 349                         secs *= HOURS;
 350                         break;
 351                 case 'd':
 352                 case 'D':
 353                         secs *= DAYS;
 354                         break;
 355                 case 'w':
 356                 case 'W':
 357                         secs *= WEEKS;
 358                         break;
 359                 default:
 360                         return -1;
 361                 }
 362                 total += secs;
 363                 if (total < 0)
 364                         return -1;
 365                 p = endp;
 366         }
 367
 368         return total;
 369 }
 370
 371 /*
 372  * Returns a standardized host+port identifier string.
 373  * Caller must free returned string.
 374  */
 375 char *
 376 put_host_port(const char *host, u_short port)
 377 {
 378         char *hoststr;
 379
 380         if (port == 0 || port == SSH_DEFAULT_PORT)
 381                 return(xstrdup(host));
 382         if (asprintf(&hoststr, "[%s]:%d", host, (int)port) < 0)
 383                 fatal("put_host_port: asprintf: %s", strerror(errno));
 384         debug3("put_host_port: %s", hoststr);
 385         return hoststr;
 386 }
 387
 388 /*
 389  * Search for next delimiter between hostnames/addresses and ports.
 390  * Argument may be modified (for termination).
 391  * Returns *cp if parsing succeeds.
 392  * *cp is set to the start of the next delimiter, if one was found.
 393  * If this is the last field, *cp is set to NULL.
 394  */
 395 char *
 396 hpdelim(char **cp)
 397 {
 398         char *s, *old;
 399
 400         if (cp == NULL || *cp == NULL)
 401                 return NULL;
 402
 403         old = s = *cp;
 404         if (*s == '[') {
 405                 if ((s = strchr(s, ']')) == NULL)
 406                         return NULL;
 407                 else
 408                         s++;
 409         } else if ((s = strpbrk(s, ":/")) == NULL)
 410                 s = *cp + strlen(*cp); /* skip to end (see first case below) */
 411
 412         switch (*s) {
 413         case '\0':
 414                 *cp = NULL;     /* no more fields*/
 415                 break;
 416
 417         case ':':
 418         case '/':
 419                 *s = '\0';      /* terminate */
 420                 *cp = s + 1;
 421                 break;
 422
 423         default:
 424                 return NULL;
 425         }
 426
 427         return old;
 428 }
 429
 430 char *
 431 cleanhostname(char *host)
 432 {
 433         if (*host == '[' && host[strlen(host) - 1] == ']') {
 434                 host[strlen(host) - 1] = '\0';
 435                 return (host + 1);
 436         } else
 437                 return host;
 438 }
 439
 440 char *
 441 colon(char *cp)
 442 {
 443         int flag = 0;
 444
 445         if (*cp == ':')         /* Leading colon is part of file name. */
 446                 return (0);
 447         if (*cp == '[')
 448                 flag = 1;
 449
 450         for (; *cp; ++cp) {
 451                 if (*cp == '@' && *(cp+1) == '[')
 452                         flag = 1;
 453                 if (*cp == ']' && *(cp+1) == ':' && flag)
 454                         return (cp+1);
 455                 if (*cp == ':' && !flag)
 456                         return (cp);
 457                 if (*cp == '/')
 458                         return (0);
 459         }
 460         return (0);
 461 }
 462
 463 /* function to assist building execv() arguments */
 464 void
 465 addargs(arglist *args, char *fmt, ...)
 466 {
 467         va_list ap;
 468         char *cp;
 469         u_int nalloc;
 470         int r;
 471
 472         va_start(ap, fmt);
 473         r = vasprintf(&cp, fmt, ap);
 474         va_end(ap);
 475         if (r == -1)
 476                 fatal("addargs: argument too long");
 477
 478         nalloc = args->nalloc;
 479         if (args->list == NULL) {
 480                 nalloc = 32;
 481                 args->num = 0;
 482         } else if (args->num+2 >= nalloc)
 483                 nalloc *= 2;
 484
 485         args->list = xrealloc(args->list, nalloc, sizeof(char *));
 486         args->nalloc = nalloc;
 487         args->list[args->num++] = cp;
 488         args->list[args->num] = NULL;
 489 }
 490
 491 void
 492 replacearg(arglist *args, u_int which, char *fmt, ...)
 493 {
 494         va_list ap;
 495         char *cp;
 496         int r;
 497
 498         va_start(ap, fmt);
 499         r = vasprintf(&cp, fmt, ap);
 500         va_end(ap);
 501         if (r == -1)
 502                 fatal("replacearg: argument too long");
 503
 504         if (which >= args->num)
 505                 fatal("replacearg: tried to replace invalid arg %d >= %d",
 506                     which, args->num);
 507         xfree(args->list[which]);
 508         args->list[which] = cp;
 509 }
 510
 511 void
 512 freeargs(arglist *args)
 513 {
 514         u_int i;
 515
 516         if (args->list != NULL) {
 517                 for (i = 0; i < args->num; i++)
 518                         xfree(args->list[i]);
 519                 xfree(args->list);
 520                 args->nalloc = args->num = 0;
 521                 args->list = NULL;
 522         }
 523 }
 524
 525 /*
 526  * Expands tildes in the file name.  Returns data allocated by xmalloc.
 527  * Warning: this calls getpw*.
 528  */
 529 char *
 530 tilde_expand_filename(const char *filename, uid_t uid)
 531 {
 532         const char *path;
 533         char user[128], ret[MAXPATHLEN];
 534         struct passwd *pw;
 535         u_int len, slash;
 536
 537         if (*filename != '~')
 538                 return (xstrdup(filename));
 539         filename++;
 540
 541         path = strchr(filename, '/');
 542         if (path != NULL && path > filename) {          /* ~user/path */
 543                 slash = path - filename;
 544                 if (slash > sizeof(user) - 1)
 545                         fatal("tilde_expand_filename: ~username too long");
 546                 memcpy(user, filename, slash);
 547                 user[slash] = '\0';
 548                 if ((pw = getpwnam(user)) == NULL)
 549                         fatal("tilde_expand_filename: No such user %s", user);
 550         } else if ((pw = getpwuid(uid)) == NULL)        /* ~/path */
 551                 fatal("tilde_expand_filename: No such uid %ld", (long)uid);
 552
 553         if (strlcpy(ret, pw->pw_dir, sizeof(ret)) >= sizeof(ret))
 554                 fatal("tilde_expand_filename: Path too long");
 555
 556         /* Make sure directory has a trailing '/' */
 557         len = strlen(pw->pw_dir);
 558         if ((len == 0 || pw->pw_dir[len - 1] != '/') &&
 559             strlcat(ret, "/", sizeof(ret)) >= sizeof(ret))
 560                 fatal("tilde_expand_filename: Path too long");
 561
 562         /* Skip leading '/' from specified path */
 563         if (path != NULL)
 564                 filename = path + 1;
 565         if (strlcat(ret, filename, sizeof(ret)) >= sizeof(ret))
 566                 fatal("tilde_expand_filename: Path too long");
 567
 568         return (xstrdup(ret));
 569 }
 570
 571 /*
 572  * Expand a string with a set of %[char] escapes. A number of escapes may be
 573  * specified as (char *escape_chars, char *replacement) pairs. The list must
 574  * be terminated by a NULL escape_char. Returns replaced string in memory
 575  * allocated by xmalloc.
 576  */
 577 char *
 578 percent_expand(const char *string, ...)
 579 {
 580 #define EXPAND_MAX_KEYS 16
 581         struct {
 582                 const char *key;
 583                 const char *repl;
 584         } keys[EXPAND_MAX_KEYS];
 585         u_int num_keys, i, j;
 586         char buf[4096];
 587         va_list ap;
 588
 589         /* Gather keys */
 590         va_start(ap, string);
 591         for (num_keys = 0; num_keys < EXPAND_MAX_KEYS; num_keys++) {
 592                 keys[num_keys].key = va_arg(ap, char *);
 593                 if (keys[num_keys].key == NULL)
 594                         break;
 595                 keys[num_keys].repl = va_arg(ap, char *);
 596                 if (keys[num_keys].repl == NULL)
 597                         fatal("percent_expand: NULL replacement");
 598         }
 599         va_end(ap);
 600
 601         if (num_keys >= EXPAND_MAX_KEYS)
 602                 fatal("percent_expand: too many keys");
 603
 604         /* Expand string */
 605         *buf = '\0';
 606         for (i = 0; *string != '\0'; string++) {
 607                 if (*string != '%') {
 608  append:
 609                         buf[i++] = *string;
 610                         if (i >= sizeof(buf))
 611                                 fatal("percent_expand: string too long");
 612                         buf[i] = '\0';
 613                         continue;
 614                 }
 615                 string++;
 616                 if (*string == '%')
 617                         goto append;
 618                 for (j = 0; j < num_keys; j++) {
 619                         if (strchr(keys[j].key, *string) != NULL) {
 620                                 i = strlcat(buf, keys[j].repl, sizeof(buf));
 621                                 if (i >= sizeof(buf))
 622                                         fatal("percent_expand: string too long");
 623                                 break;
 624                         }
 625                 }
 626                 if (j >= num_keys)
 627                         fatal("percent_expand: unknown key %%%c", *string);
 628         }
 629         return (xstrdup(buf));
 630 #undef EXPAND_MAX_KEYS
 631 }
 632
 633 /*
 634  * Read an entire line from a public key file into a static buffer, discarding
 635  * lines that exceed the buffer size.  Returns 0 on success, -1 on failure.
 636  */
 637 int
 638 read_keyfile_line(FILE *f, const char *filename, char *buf, size_t bufsz,
 639    u_long *lineno)
 640 {
 641         while (fgets(buf, bufsz, f) != NULL) {
 642                 if (buf[0] == '\0')
 643                         continue;
 644                 (*lineno)++;
 645                 if (buf[strlen(buf) - 1] == '\n' || feof(f)) {
 646                         return 0;
 647                 } else {
 648                         debug("%s: %s line %lu exceeds size limit", __func__,
 649                             filename, *lineno);
 650                         /* discard remainder of line */
 651                         while (fgetc(f) != '\n' && !feof(f))
 652                                 ;       /* nothing */
 653                 }
 654         }
 655         return -1;
 656 }
 657
 658 int
 659 tun_open(int tun, int mode)
 660 {
 661 #if defined(CUSTOM_SYS_TUN_OPEN)
 662         return (sys_tun_open(tun, mode));
 663 #elif defined(SSH_TUN_OPENBSD)
 664         struct ifreq ifr;
 665         char name[100];
 666         int fd = -1, sock;
 667
 668         /* Open the tunnel device */
 669         if (tun <= SSH_TUNID_MAX) {
 670                 snprintf(name, sizeof(name), "/dev/tun%d", tun);
 671                 fd = open(name, O_RDWR);
 672         } else if (tun == SSH_TUNID_ANY) {
 673                 for (tun = 100; tun >= 0; tun--) {
 674                         snprintf(name, sizeof(name), "/dev/tun%d", tun);
 675                         if ((fd = open(name, O_RDWR)) >= 0)
 676                                 break;
 677                 }
 678         } else {
 679                 debug("%s: invalid tunnel %u", __func__, tun);
 680                 return (-1);
 681         }
 682
 683         if (fd < 0) {
 684                 debug("%s: %s open failed: %s", __func__, name, strerror(errno));
 685                 return (-1);
 686         }
 687
 688         debug("%s: %s mode %d fd %d", __func__, name, mode, fd);
 689
 690         /* Set the tunnel device operation mode */
 691         snprintf(ifr.ifr_name, sizeof(ifr.ifr_name), "tun%d", tun);
 692         if ((sock = socket(PF_UNIX, SOCK_STREAM, 0)) == -1)
 693                 goto failed;
 694
 695         if (ioctl(sock, SIOCGIFFLAGS, &ifr) == -1)
 696                 goto failed;
 697
 698         /* Set interface mode */
 699         ifr.ifr_flags &= ~IFF_UP;
 700         if (mode == SSH_TUNMODE_ETHERNET)
 701                 ifr.ifr_flags |= IFF_LINK0;
 702         else
 703                 ifr.ifr_flags &= ~IFF_LINK0;
 704         if (ioctl(sock, SIOCSIFFLAGS, &ifr) == -1)
 705                 goto failed;
 706
 707         /* Bring interface up */
 708         ifr.ifr_flags |= IFF_UP;
 709         if (ioctl(sock, SIOCSIFFLAGS, &ifr) == -1)
 710                 goto failed;
 711
 712         close(sock);
 713         return (fd);
 714
 715  failed:
 716         if (fd >= 0)
 717                 close(fd);
 718         if (sock >= 0)
 719                 close(sock);
 720         debug("%s: failed to set %s mode %d: %s", __func__, name,
 721             mode, strerror(errno));
 722         return (-1);
 723 #else
 724         error("Tunnel interfaces are not supported on this platform");
 725         return (-1);
 726 #endif
 727 }
 728
 729 void
 730 sanitise_stdfd(void)
 731 {
 732         int nullfd, dupfd;
 733
 734         if ((nullfd = dupfd = open(_PATH_DEVNULL, O_RDWR)) == -1) {
 735                 fprintf(stderr, "Couldn't open /dev/null: %s\n",
 736                     strerror(errno));
 737                 exit(1);
 738         }
 739         while (++dupfd <= 2) {
 740                 /* Only clobber closed fds */
 741                 if (fcntl(dupfd, F_GETFL, 0) >= 0)
 742                         continue;
 743                 if (dup2(nullfd, dupfd) == -1) {
 744                         fprintf(stderr, "dup2: %s\n", strerror(errno));
 745                         exit(1);
 746                 }
 747         }
 748         if (nullfd > 2)
 749                 close(nullfd);
 750 }
 751
 752 char *
 753 tohex(const void *vp, size_t l)
 754 {
 755         const u_char *p = (const u_char *)vp;
 756         char b[3], *r;
 757         size_t i, hl;
 758
 759         if (l > 65536)
 760                 return xstrdup("tohex: length > 65536");
 761
 762         hl = l * 2 + 1;
 763         r = xcalloc(1, hl);
 764         for (i = 0; i < l; i++) {
 765                 snprintf(b, sizeof(b), "%02x", p[i]);
 766                 strlcat(r, b, hl);
 767         }
 768         return (r);
 769 }
 770
 771 u_int64_t
 772 get_u64(const void *vp)
 773 {
 774         const u_char *p = (const u_char *)vp;
 775         u_int64_t v;
 776
 777         v  = (u_int64_t)p[0] << 56;
 778         v |= (u_int64_t)p[1] << 48;
 779         v |= (u_int64_t)p[2] << 40;
 780         v |= (u_int64_t)p[3] << 32;
 781         v |= (u_int64_t)p[4] << 24;
 782         v |= (u_int64_t)p[5] << 16;
 783         v |= (u_int64_t)p[6] << 8;
 784         v |= (u_int64_t)p[7];
 785
 786         return (v);
 787 }
 788
 789 u_int32_t
 790 get_u32(const void *vp)
 791 {
 792         const u_char *p = (const u_char *)vp;
 793         u_int32_t v;
 794
 795         v  = (u_int32_t)p[0] << 24;
 796         v |= (u_int32_t)p[1] << 16;
 797         v |= (u_int32_t)p[2] << 8;
 798         v |= (u_int32_t)p[3];
 799
 800         return (v);
 801 }
 802
 803 u_int16_t
 804 get_u16(const void *vp)
 805 {
 806         const u_char *p = (const u_char *)vp;
 807         u_int16_t v;
 808
 809         v  = (u_int16_t)p[0] << 8;
 810         v |= (u_int16_t)p[1];
 811
 812         return (v);
 813 }
 814
 815 void
 816 put_u64(void *vp, u_int64_t v)
 817 {
 818         u_char *p = (u_char *)vp;
 819
 820         p[0] = (u_char)(v >> 56) & 0xff;
 821         p[1] = (u_char)(v >> 48) & 0xff;
 822         p[2] = (u_char)(v >> 40) & 0xff;
 823         p[3] = (u_char)(v >> 32) & 0xff;
 824         p[4] = (u_char)(v >> 24) & 0xff;
 825         p[5] = (u_char)(v >> 16) & 0xff;
 826         p[6] = (u_char)(v >> 8) & 0xff;
 827         p[7] = (u_char)v & 0xff;
 828 }
 829
 830 void
 831 put_u32(void *vp, u_int32_t v)
 832 {
 833         u_char *p = (u_char *)vp;
 834
 835         p[0] = (u_char)(v >> 24) & 0xff;
 836         p[1] = (u_char)(v >> 16) & 0xff;
 837         p[2] = (u_char)(v >> 8) & 0xff;
 838         p[3] = (u_char)v & 0xff;
 839 }
 840
 841
 842 void
 843 put_u16(void *vp, u_int16_t v)
 844 {
 845         u_char *p = (u_char *)vp;
 846
 847         p[0] = (u_char)(v >> 8) & 0xff;
 848         p[1] = (u_char)v & 0xff;
 849 }
 850
 851 void
 852 ms_subtract_diff(struct timeval *start, int *ms)
 853 {
 854         struct timeval diff, finish;
 855
 856         gettimeofday(&finish, NULL);
 857         timersub(&finish, start, &diff);
 858         *ms -= (diff.tv_sec * 1000) + (diff.tv_usec / 1000);
 859 }
 860
 861 void
 862 ms_to_timeval(struct timeval *tv, int ms)
 863 {
 864         if (ms < 0)
 865                 ms = 0;
 866         tv->tv_sec = ms / 1000;
 867         tv->tv_usec = (ms % 1000) * 1000;
 868 }
 869