misc.c

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