misc.c

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