misc.c

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