Annotation of src/usr.bin/ssh/misc.c, Revision 1.98
1.98 ! djm 1: /* $OpenBSD: misc.c,v 1.97 2015/04/24 01:36:00 deraadt Exp $ */
1.1 markus 2: /*
3: * Copyright (c) 2000 Markus Friedl. All rights reserved.
1.52 djm 4: * Copyright (c) 2005,2006 Damien Miller. All rights reserved.
1.1 markus 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:
1.64 deraadt 27: #include <sys/types.h>
1.45 stevesk 28: #include <sys/ioctl.h>
1.53 stevesk 29: #include <sys/socket.h>
1.94 millert 30: #include <sys/un.h>
1.38 stevesk 31:
32: #include <net/if.h>
1.53 stevesk 33: #include <netinet/in.h>
1.83 djm 34: #include <netinet/ip.h>
1.44 stevesk 35: #include <netinet/tcp.h>
1.43 stevesk 36:
1.92 djm 37: #include <ctype.h>
1.58 stevesk 38: #include <errno.h>
1.55 stevesk 39: #include <fcntl.h>
1.66 dtucker 40: #include <netdb.h>
1.43 stevesk 41: #include <paths.h>
1.54 stevesk 42: #include <pwd.h>
1.96 deraadt 43: #include <limits.h>
1.57 stevesk 44: #include <stdarg.h>
1.63 stevesk 45: #include <stdio.h>
1.62 stevesk 46: #include <stdlib.h>
1.60 stevesk 47: #include <string.h>
1.59 stevesk 48: #include <unistd.h>
1.1 markus 49:
1.64 deraadt 50: #include "xmalloc.h"
1.1 markus 51: #include "misc.h"
52: #include "log.h"
1.56 dtucker 53: #include "ssh.h"
1.1 markus 54:
1.12 markus 55: /* remove newline at end of string */
1.1 markus 56: char *
57: chop(char *s)
58: {
59: char *t = s;
60: while (*t) {
1.13 deraadt 61: if (*t == '\n' || *t == '\r') {
1.1 markus 62: *t = '\0';
63: return s;
64: }
65: t++;
66: }
67: return s;
68:
69: }
70:
1.12 markus 71: /* set/unset filedescriptor to non-blocking */
1.24 djm 72: int
1.1 markus 73: set_nonblock(int fd)
74: {
75: int val;
1.8 markus 76:
1.1 markus 77: val = fcntl(fd, F_GETFL, 0);
78: if (val < 0) {
79: error("fcntl(%d, F_GETFL, 0): %s", fd, strerror(errno));
1.24 djm 80: return (-1);
1.1 markus 81: }
82: if (val & O_NONBLOCK) {
1.24 djm 83: debug3("fd %d is O_NONBLOCK", fd);
84: return (0);
1.1 markus 85: }
1.21 markus 86: debug2("fd %d setting O_NONBLOCK", fd);
1.1 markus 87: val |= O_NONBLOCK;
1.24 djm 88: if (fcntl(fd, F_SETFL, val) == -1) {
89: debug("fcntl(%d, F_SETFL, O_NONBLOCK): %s", fd,
90: strerror(errno));
91: return (-1);
92: }
93: return (0);
1.8 markus 94: }
95:
1.24 djm 96: int
1.8 markus 97: unset_nonblock(int fd)
98: {
99: int val;
100:
101: val = fcntl(fd, F_GETFL, 0);
102: if (val < 0) {
103: error("fcntl(%d, F_GETFL, 0): %s", fd, strerror(errno));
1.24 djm 104: return (-1);
1.8 markus 105: }
106: if (!(val & O_NONBLOCK)) {
1.24 djm 107: debug3("fd %d is not O_NONBLOCK", fd);
108: return (0);
1.8 markus 109: }
1.10 markus 110: debug("fd %d clearing O_NONBLOCK", fd);
1.8 markus 111: val &= ~O_NONBLOCK;
1.24 djm 112: if (fcntl(fd, F_SETFL, val) == -1) {
113: debug("fcntl(%d, F_SETFL, ~O_NONBLOCK): %s",
1.18 markus 114: fd, strerror(errno));
1.24 djm 115: return (-1);
116: }
117: return (0);
1.66 dtucker 118: }
119:
120: const char *
121: ssh_gai_strerror(int gaierr)
122: {
1.91 djm 123: if (gaierr == EAI_SYSTEM && errno != 0)
1.67 dtucker 124: return strerror(errno);
125: return gai_strerror(gaierr);
1.15 stevesk 126: }
127:
128: /* disable nagle on socket */
129: void
130: set_nodelay(int fd)
131: {
1.17 stevesk 132: int opt;
133: socklen_t optlen;
1.15 stevesk 134:
1.16 stevesk 135: optlen = sizeof opt;
136: if (getsockopt(fd, IPPROTO_TCP, TCP_NODELAY, &opt, &optlen) == -1) {
1.23 markus 137: debug("getsockopt TCP_NODELAY: %.100s", strerror(errno));
1.16 stevesk 138: return;
139: }
140: if (opt == 1) {
141: debug2("fd %d is TCP_NODELAY", fd);
142: return;
143: }
144: opt = 1;
1.20 markus 145: debug2("fd %d setting TCP_NODELAY", fd);
1.16 stevesk 146: if (setsockopt(fd, IPPROTO_TCP, TCP_NODELAY, &opt, sizeof opt) == -1)
1.15 stevesk 147: error("setsockopt TCP_NODELAY: %.100s", strerror(errno));
1.72 reyk 148: }
149:
1.1 markus 150: /* Characters considered whitespace in strsep calls. */
151: #define WHITESPACE " \t\r\n"
1.46 dtucker 152: #define QUOTE "\""
1.1 markus 153:
1.12 markus 154: /* return next token in configuration line */
1.1 markus 155: char *
156: strdelim(char **s)
157: {
158: char *old;
159: int wspace = 0;
160:
161: if (*s == NULL)
162: return NULL;
163:
164: old = *s;
165:
1.46 dtucker 166: *s = strpbrk(*s, WHITESPACE QUOTE "=");
1.1 markus 167: if (*s == NULL)
168: return (old);
169:
1.46 dtucker 170: if (*s[0] == '\"') {
171: memmove(*s, *s + 1, strlen(*s)); /* move nul too */
172: /* Find matching quote */
173: if ((*s = strpbrk(*s, QUOTE)) == NULL) {
174: return (NULL); /* no matching quote */
175: } else {
176: *s[0] = '\0';
1.77 djm 177: *s += strspn(*s + 1, WHITESPACE) + 1;
1.46 dtucker 178: return (old);
179: }
180: }
181:
1.1 markus 182: /* Allow only one '=' to be skipped */
183: if (*s[0] == '=')
184: wspace = 1;
185: *s[0] = '\0';
186:
1.46 dtucker 187: /* Skip any extra whitespace after first token */
1.1 markus 188: *s += strspn(*s + 1, WHITESPACE) + 1;
189: if (*s[0] == '=' && !wspace)
190: *s += strspn(*s + 1, WHITESPACE) + 1;
191:
192: return (old);
1.2 markus 193: }
194:
195: struct passwd *
196: pwcopy(struct passwd *pw)
197: {
1.49 djm 198: struct passwd *copy = xcalloc(1, sizeof(*copy));
1.4 deraadt 199:
1.2 markus 200: copy->pw_name = xstrdup(pw->pw_name);
201: copy->pw_passwd = xstrdup(pw->pw_passwd);
1.4 deraadt 202: copy->pw_gecos = xstrdup(pw->pw_gecos);
1.2 markus 203: copy->pw_uid = pw->pw_uid;
204: copy->pw_gid = pw->pw_gid;
1.11 markus 205: copy->pw_expire = pw->pw_expire;
206: copy->pw_change = pw->pw_change;
1.2 markus 207: copy->pw_class = xstrdup(pw->pw_class);
208: copy->pw_dir = xstrdup(pw->pw_dir);
209: copy->pw_shell = xstrdup(pw->pw_shell);
210: return copy;
1.5 stevesk 211: }
212:
1.12 markus 213: /*
214: * Convert ASCII string to TCP/IP port number.
1.70 djm 215: * Port must be >=0 and <=65535.
216: * Return -1 if invalid.
1.12 markus 217: */
218: int
219: a2port(const char *s)
1.5 stevesk 220: {
1.70 djm 221: long long port;
222: const char *errstr;
1.5 stevesk 223:
1.70 djm 224: port = strtonum(s, 0, 65535, &errstr);
225: if (errstr != NULL)
226: return -1;
227: return (int)port;
1.9 stevesk 228: }
229:
1.36 reyk 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) {
1.37 reyk 238: *remote = SSH_TUNID_ANY;
1.36 reyk 239: sp = xstrdup(s);
240: if ((ep = strchr(sp, ':')) == NULL) {
1.89 djm 241: free(sp);
1.36 reyk 242: return (a2tun(s, NULL));
243: }
244: ep[0] = '\0'; ep++;
245: *remote = a2tun(ep, NULL);
246: tun = a2tun(sp, NULL);
1.89 djm 247: free(sp);
1.37 reyk 248: return (*remote == SSH_TUNID_ERR ? *remote : tun);
1.36 reyk 249: }
250:
251: if (strcasecmp(s, "any") == 0)
1.37 reyk 252: return (SSH_TUNID_ANY);
1.36 reyk 253:
1.37 reyk 254: tun = strtonum(s, 0, SSH_TUNID_MAX, &errstr);
255: if (errstr != NULL)
256: return (SSH_TUNID_ERR);
1.36 reyk 257:
258: return (tun);
259: }
260:
1.9 stevesk 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:
1.12 markus 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)
1.9 stevesk 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--;
1.48 deraadt 312: break;
1.9 stevesk 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;
1.56 dtucker 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;
1.28 djm 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;
1.29 deraadt 389:
1.28 djm 390: case ':':
391: case '/':
392: *s = '\0'; /* terminate */
393: *cp = s + 1;
394: break;
1.29 deraadt 395:
1.28 djm 396: default:
397: return NULL;
398: }
399:
400: return old;
1.6 mouring 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. */
1.76 djm 419: return NULL;
1.6 mouring 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 == '/')
1.76 djm 431: return NULL;
1.6 mouring 432: }
1.76 djm 433: return NULL;
1.7 mouring 434: }
435:
1.12 markus 436: /* function to assist building execv() arguments */
1.7 mouring 437: void
438: addargs(arglist *args, char *fmt, ...)
439: {
440: va_list ap;
1.42 djm 441: char *cp;
1.25 avsm 442: u_int nalloc;
1.42 djm 443: int r;
1.7 mouring 444:
445: va_start(ap, fmt);
1.42 djm 446: r = vasprintf(&cp, fmt, ap);
1.7 mouring 447: va_end(ap);
1.42 djm 448: if (r == -1)
449: fatal("addargs: argument too long");
1.7 mouring 450:
1.22 markus 451: nalloc = args->nalloc;
1.7 mouring 452: if (args->list == NULL) {
1.22 markus 453: nalloc = 32;
1.7 mouring 454: args->num = 0;
1.22 markus 455: } else if (args->num+2 >= nalloc)
456: nalloc *= 2;
1.7 mouring 457:
1.97 deraadt 458: args->list = xreallocarray(args->list, nalloc, sizeof(char *));
1.22 markus 459: args->nalloc = nalloc;
1.42 djm 460: args->list[args->num++] = cp;
1.7 mouring 461: args->list[args->num] = NULL;
1.42 djm 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);
1.89 djm 480: free(args->list[which]);
1.42 djm 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++)
1.89 djm 491: free(args->list[i]);
492: free(args->list);
1.42 djm 493: args->nalloc = args->num = 0;
494: args->list = NULL;
495: }
1.30 djm 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: {
1.87 tedu 505: const char *path, *sep;
506: char user[128], *ret;
1.30 djm 507: struct passwd *pw;
1.32 djm 508: u_int len, slash;
1.30 djm 509:
510: if (*filename != '~')
511: return (xstrdup(filename));
512: filename++;
513:
514: path = strchr(filename, '/');
515: if (path != NULL && path > filename) { /* ~user/path */
1.32 djm 516: slash = path - filename;
517: if (slash > sizeof(user) - 1)
1.30 djm 518: fatal("tilde_expand_filename: ~username too long");
1.32 djm 519: memcpy(user, filename, slash);
520: user[slash] = '\0';
1.30 djm 521: if ((pw = getpwnam(user)) == NULL)
522: fatal("tilde_expand_filename: No such user %s", user);
523: } else if ((pw = getpwuid(uid)) == NULL) /* ~/path */
1.69 dtucker 524: fatal("tilde_expand_filename: No such uid %ld", (long)uid);
1.30 djm 525:
526: /* Make sure directory has a trailing '/' */
527: len = strlen(pw->pw_dir);
1.88 tedu 528: if (len == 0 || pw->pw_dir[len - 1] != '/')
1.87 tedu 529: sep = "/";
530: else
531: sep = "";
1.30 djm 532:
533: /* Skip leading '/' from specified path */
534: if (path != NULL)
535: filename = path + 1;
1.87 tedu 536:
1.96 deraadt 537: if (xasprintf(&ret, "%s%s%s", pw->pw_dir, sep, filename) >= PATH_MAX)
1.30 djm 538: fatal("tilde_expand_filename: Path too long");
539:
1.87 tedu 540: return (ret);
1.31 djm 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
1.34 dtucker 546: * be terminated by a NULL escape_char. Returns replaced string in memory
1.31 djm 547: * allocated by xmalloc.
548: */
549: char *
550: percent_expand(const char *string, ...)
551: {
552: #define EXPAND_MAX_KEYS 16
1.73 djm 553: u_int num_keys, i, j;
1.31 djm 554: struct {
555: const char *key;
556: const char *repl;
557: } keys[EXPAND_MAX_KEYS];
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)
1.73 djm 569: fatal("%s: NULL replacement", __func__);
1.31 djm 570: }
1.73 djm 571: if (num_keys == EXPAND_MAX_KEYS && va_arg(ap, char *) != NULL)
572: fatal("%s: too many keys", __func__);
1.31 djm 573: va_end(ap);
574:
575: /* Expand string */
576: *buf = '\0';
577: for (i = 0; *string != '\0'; string++) {
578: if (*string != '%') {
579: append:
580: buf[i++] = *string;
581: if (i >= sizeof(buf))
1.73 djm 582: fatal("%s: string too long", __func__);
1.31 djm 583: buf[i] = '\0';
584: continue;
585: }
586: string++;
1.73 djm 587: /* %% case */
1.31 djm 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))
1.73 djm 594: fatal("%s: string too long", __func__);
1.31 djm 595: break;
596: }
597: }
598: if (j >= num_keys)
1.73 djm 599: fatal("%s: unknown key %%%c", __func__, *string);
1.31 djm 600: }
601: return (xstrdup(buf));
602: #undef EXPAND_MAX_KEYS
1.26 dtucker 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,
1.27 dtucker 611: u_long *lineno)
1.26 dtucker 612: {
613: while (fgets(buf, bufsz, f) != NULL) {
1.65 ray 614: if (buf[0] == '\0')
615: continue;
1.26 dtucker 616: (*lineno)++;
617: if (buf[strlen(buf) - 1] == '\n' || feof(f)) {
618: return 0;
619: } else {
1.27 dtucker 620: debug("%s: %s line %lu exceeds size limit", __func__,
621: filename, *lineno);
1.26 dtucker 622: /* discard remainder of line */
1.29 deraadt 623: while (fgetc(f) != '\n' && !feof(f))
1.26 dtucker 624: ; /* nothing */
625: }
626: }
627: return -1;
1.36 reyk 628: }
629:
630: int
1.37 reyk 631: tun_open(int tun, int mode)
1.36 reyk 632: {
1.37 reyk 633: struct ifreq ifr;
1.36 reyk 634: char name[100];
1.37 reyk 635: int fd = -1, sock;
1.36 reyk 636:
1.37 reyk 637: /* Open the tunnel device */
638: if (tun <= SSH_TUNID_MAX) {
1.36 reyk 639: snprintf(name, sizeof(name), "/dev/tun%d", tun);
1.37 reyk 640: fd = open(name, O_RDWR);
641: } else if (tun == SSH_TUNID_ANY) {
642: for (tun = 100; tun >= 0; tun--) {
643: snprintf(name, sizeof(name), "/dev/tun%d", tun);
644: if ((fd = open(name, O_RDWR)) >= 0)
645: break;
1.36 reyk 646: }
647: } else {
1.39 stevesk 648: debug("%s: invalid tunnel %u", __func__, tun);
1.98 ! djm 649: return -1;
1.37 reyk 650: }
651:
652: if (fd < 0) {
1.98 ! djm 653: debug("%s: %s open: %s", __func__, name, strerror(errno));
! 654: return -1;
1.36 reyk 655: }
1.37 reyk 656:
657: debug("%s: %s mode %d fd %d", __func__, name, mode, fd);
658:
659: /* Set the tunnel device operation mode */
660: snprintf(ifr.ifr_name, sizeof(ifr.ifr_name), "tun%d", tun);
1.98 ! djm 661: if ((sock = socket(PF_UNIX, SOCK_STREAM, 0)) == -1) {
! 662: error("%s: socket: %s", __func__, strerror(errno));
1.37 reyk 663: goto failed;
1.98 ! djm 664: }
1.37 reyk 665:
1.98 ! djm 666: if (ioctl(sock, SIOCGIFFLAGS, &ifr) == -1) {
! 667: debug("%s: get interface %s flags: %s", __func__,
! 668: ifr.ifr_name, strerror(errno));
1.37 reyk 669: goto failed;
1.98 ! djm 670: }
1.40 reyk 671:
1.98 ! djm 672: /* Set interface mode if not already in correct mode */
! 673: if ((mode == SSH_TUNMODE_ETHERNET && !(ifr.ifr_flags & IFF_LINK0)) ||
! 674: (mode != SSH_TUNMODE_ETHERNET && (ifr.ifr_flags & IFF_LINK0))) {
! 675: ifr.ifr_flags &= ~IFF_UP;
! 676: ifr.ifr_flags ^= IFF_LINK0;
! 677: if (ioctl(sock, SIOCSIFFLAGS, &ifr) == -1) {
! 678: debug("%s: reset interface %s flags: %s", __func__,
! 679: ifr.ifr_name, strerror(errno));
! 680: goto failed;
! 681: }
! 682: }
1.40 reyk 683:
1.98 ! djm 684: /* Bring interface up if it is not already */
! 685: if (!(ifr.ifr_flags & IFF_UP)) {
! 686: ifr.ifr_flags |= IFF_UP;
! 687: if (ioctl(sock, SIOCSIFFLAGS, &ifr) == -1) {
! 688: debug("%s: activate interface %s: %s", __func__,
! 689: ifr.ifr_name, strerror(errno));
! 690: goto failed;
! 691: }
! 692: }
1.37 reyk 693:
694: close(sock);
1.98 ! djm 695: return fd;
1.37 reyk 696:
697: failed:
698: if (fd >= 0)
699: close(fd);
700: if (sock >= 0)
701: close(sock);
1.98 ! djm 702: return -1;
1.35 djm 703: }
704:
705: void
706: sanitise_stdfd(void)
707: {
1.41 djm 708: int nullfd, dupfd;
1.35 djm 709:
1.41 djm 710: if ((nullfd = dupfd = open(_PATH_DEVNULL, O_RDWR)) == -1) {
1.71 tobias 711: fprintf(stderr, "Couldn't open /dev/null: %s\n",
712: strerror(errno));
1.35 djm 713: exit(1);
714: }
1.41 djm 715: while (++dupfd <= 2) {
716: /* Only clobber closed fds */
717: if (fcntl(dupfd, F_GETFL, 0) >= 0)
718: continue;
719: if (dup2(nullfd, dupfd) == -1) {
1.71 tobias 720: fprintf(stderr, "dup2: %s\n", strerror(errno));
1.35 djm 721: exit(1);
722: }
723: }
724: if (nullfd > 2)
725: close(nullfd);
1.1 markus 726: }
1.33 djm 727:
728: char *
1.52 djm 729: tohex(const void *vp, size_t l)
1.33 djm 730: {
1.52 djm 731: const u_char *p = (const u_char *)vp;
1.33 djm 732: char b[3], *r;
1.52 djm 733: size_t i, hl;
734:
735: if (l > 65536)
736: return xstrdup("tohex: length > 65536");
1.33 djm 737:
738: hl = l * 2 + 1;
1.49 djm 739: r = xcalloc(1, hl);
1.33 djm 740: for (i = 0; i < l; i++) {
1.52 djm 741: snprintf(b, sizeof(b), "%02x", p[i]);
1.33 djm 742: strlcat(r, b, hl);
743: }
744: return (r);
745: }
746:
1.52 djm 747: u_int64_t
748: get_u64(const void *vp)
749: {
750: const u_char *p = (const u_char *)vp;
751: u_int64_t v;
752:
753: v = (u_int64_t)p[0] << 56;
754: v |= (u_int64_t)p[1] << 48;
755: v |= (u_int64_t)p[2] << 40;
756: v |= (u_int64_t)p[3] << 32;
757: v |= (u_int64_t)p[4] << 24;
758: v |= (u_int64_t)p[5] << 16;
759: v |= (u_int64_t)p[6] << 8;
760: v |= (u_int64_t)p[7];
761:
762: return (v);
763: }
764:
765: u_int32_t
766: get_u32(const void *vp)
767: {
768: const u_char *p = (const u_char *)vp;
769: u_int32_t v;
770:
771: v = (u_int32_t)p[0] << 24;
772: v |= (u_int32_t)p[1] << 16;
773: v |= (u_int32_t)p[2] << 8;
774: v |= (u_int32_t)p[3];
775:
776: return (v);
777: }
778:
1.93 djm 779: u_int32_t
780: get_u32_le(const void *vp)
781: {
782: const u_char *p = (const u_char *)vp;
783: u_int32_t v;
784:
785: v = (u_int32_t)p[0];
786: v |= (u_int32_t)p[1] << 8;
787: v |= (u_int32_t)p[2] << 16;
788: v |= (u_int32_t)p[3] << 24;
789:
790: return (v);
791: }
792:
1.52 djm 793: u_int16_t
794: get_u16(const void *vp)
795: {
796: const u_char *p = (const u_char *)vp;
797: u_int16_t v;
798:
799: v = (u_int16_t)p[0] << 8;
800: v |= (u_int16_t)p[1];
801:
802: return (v);
803: }
804:
805: void
806: put_u64(void *vp, u_int64_t v)
807: {
808: u_char *p = (u_char *)vp;
809:
810: p[0] = (u_char)(v >> 56) & 0xff;
811: p[1] = (u_char)(v >> 48) & 0xff;
812: p[2] = (u_char)(v >> 40) & 0xff;
813: p[3] = (u_char)(v >> 32) & 0xff;
814: p[4] = (u_char)(v >> 24) & 0xff;
815: p[5] = (u_char)(v >> 16) & 0xff;
816: p[6] = (u_char)(v >> 8) & 0xff;
817: p[7] = (u_char)v & 0xff;
818: }
819:
820: void
821: put_u32(void *vp, u_int32_t v)
822: {
823: u_char *p = (u_char *)vp;
824:
825: p[0] = (u_char)(v >> 24) & 0xff;
826: p[1] = (u_char)(v >> 16) & 0xff;
827: p[2] = (u_char)(v >> 8) & 0xff;
828: p[3] = (u_char)v & 0xff;
829: }
830:
1.93 djm 831: void
832: put_u32_le(void *vp, u_int32_t v)
833: {
834: u_char *p = (u_char *)vp;
835:
836: p[0] = (u_char)v & 0xff;
837: p[1] = (u_char)(v >> 8) & 0xff;
838: p[2] = (u_char)(v >> 16) & 0xff;
839: p[3] = (u_char)(v >> 24) & 0xff;
840: }
1.52 djm 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: }
1.68 dtucker 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;
1.90 dtucker 868: }
869:
870: time_t
871: monotime(void)
872: {
873: struct timespec ts;
874:
875: if (clock_gettime(CLOCK_MONOTONIC, &ts) != 0)
876: fatal("clock_gettime: %s", strerror(errno));
877:
878: return (ts.tv_sec);
1.81 djm 879: }
880:
881: void
882: bandwidth_limit_init(struct bwlimit *bw, u_int64_t kbps, size_t buflen)
883: {
884: bw->buflen = buflen;
885: bw->rate = kbps;
886: bw->thresh = bw->rate;
887: bw->lamt = 0;
888: timerclear(&bw->bwstart);
889: timerclear(&bw->bwend);
890: }
891:
892: /* Callback from read/write loop to insert bandwidth-limiting delays */
893: void
894: bandwidth_limit(struct bwlimit *bw, size_t read_len)
895: {
896: u_int64_t waitlen;
897: struct timespec ts, rm;
898:
899: if (!timerisset(&bw->bwstart)) {
900: gettimeofday(&bw->bwstart, NULL);
901: return;
902: }
903:
904: bw->lamt += read_len;
905: if (bw->lamt < bw->thresh)
906: return;
907:
908: gettimeofday(&bw->bwend, NULL);
909: timersub(&bw->bwend, &bw->bwstart, &bw->bwend);
910: if (!timerisset(&bw->bwend))
911: return;
912:
913: bw->lamt *= 8;
914: waitlen = (double)1000000L * bw->lamt / bw->rate;
915:
916: bw->bwstart.tv_sec = waitlen / 1000000L;
917: bw->bwstart.tv_usec = waitlen % 1000000L;
918:
919: if (timercmp(&bw->bwstart, &bw->bwend, >)) {
920: timersub(&bw->bwstart, &bw->bwend, &bw->bwend);
921:
922: /* Adjust the wait time */
923: if (bw->bwend.tv_sec) {
924: bw->thresh /= 2;
925: if (bw->thresh < bw->buflen / 4)
926: bw->thresh = bw->buflen / 4;
927: } else if (bw->bwend.tv_usec < 10000) {
928: bw->thresh *= 2;
929: if (bw->thresh > bw->buflen * 8)
930: bw->thresh = bw->buflen * 8;
931: }
932:
933: TIMEVAL_TO_TIMESPEC(&bw->bwend, &ts);
934: while (nanosleep(&ts, &rm) == -1) {
935: if (errno != EINTR)
936: break;
937: ts = rm;
938: }
939: }
940:
941: bw->lamt = 0;
942: gettimeofday(&bw->bwstart, NULL);
1.84 djm 943: }
944:
945: /* Make a template filename for mk[sd]temp() */
946: void
947: mktemp_proto(char *s, size_t len)
948: {
949: const char *tmpdir;
950: int r;
951:
952: if ((tmpdir = getenv("TMPDIR")) != NULL) {
953: r = snprintf(s, len, "%s/ssh-XXXXXXXXXXXX", tmpdir);
954: if (r > 0 && (size_t)r < len)
955: return;
956: }
957: r = snprintf(s, len, "/tmp/ssh-XXXXXXXXXXXX");
958: if (r < 0 || (size_t)r >= len)
959: fatal("%s: template string too short", __func__);
1.68 dtucker 960: }
1.83 djm 961:
962: static const struct {
963: const char *name;
964: int value;
965: } ipqos[] = {
966: { "af11", IPTOS_DSCP_AF11 },
967: { "af12", IPTOS_DSCP_AF12 },
968: { "af13", IPTOS_DSCP_AF13 },
1.86 djm 969: { "af21", IPTOS_DSCP_AF21 },
1.83 djm 970: { "af22", IPTOS_DSCP_AF22 },
971: { "af23", IPTOS_DSCP_AF23 },
972: { "af31", IPTOS_DSCP_AF31 },
973: { "af32", IPTOS_DSCP_AF32 },
974: { "af33", IPTOS_DSCP_AF33 },
975: { "af41", IPTOS_DSCP_AF41 },
976: { "af42", IPTOS_DSCP_AF42 },
977: { "af43", IPTOS_DSCP_AF43 },
978: { "cs0", IPTOS_DSCP_CS0 },
979: { "cs1", IPTOS_DSCP_CS1 },
980: { "cs2", IPTOS_DSCP_CS2 },
981: { "cs3", IPTOS_DSCP_CS3 },
982: { "cs4", IPTOS_DSCP_CS4 },
983: { "cs5", IPTOS_DSCP_CS5 },
984: { "cs6", IPTOS_DSCP_CS6 },
985: { "cs7", IPTOS_DSCP_CS7 },
986: { "ef", IPTOS_DSCP_EF },
987: { "lowdelay", IPTOS_LOWDELAY },
988: { "throughput", IPTOS_THROUGHPUT },
989: { "reliability", IPTOS_RELIABILITY },
990: { NULL, -1 }
991: };
992:
993: int
994: parse_ipqos(const char *cp)
995: {
996: u_int i;
997: char *ep;
998: long val;
999:
1000: if (cp == NULL)
1001: return -1;
1002: for (i = 0; ipqos[i].name != NULL; i++) {
1003: if (strcasecmp(cp, ipqos[i].name) == 0)
1004: return ipqos[i].value;
1005: }
1006: /* Try parsing as an integer */
1007: val = strtol(cp, &ep, 0);
1008: if (*cp == '\0' || *ep != '\0' || val < 0 || val > 255)
1009: return -1;
1010: return val;
1011: }
1012:
1.85 stevesk 1013: const char *
1014: iptos2str(int iptos)
1015: {
1016: int i;
1017: static char iptos_str[sizeof "0xff"];
1018:
1019: for (i = 0; ipqos[i].name != NULL; i++) {
1020: if (ipqos[i].value == iptos)
1021: return ipqos[i].name;
1022: }
1023: snprintf(iptos_str, sizeof iptos_str, "0x%02x", iptos);
1024: return iptos_str;
1.92 djm 1025: }
1026:
1027: void
1028: lowercase(char *s)
1029: {
1030: for (; *s; s++)
1031: *s = tolower((u_char)*s);
1.94 millert 1032: }
1033:
1034: int
1035: unix_listener(const char *path, int backlog, int unlink_first)
1036: {
1037: struct sockaddr_un sunaddr;
1038: int saved_errno, sock;
1039:
1040: memset(&sunaddr, 0, sizeof(sunaddr));
1041: sunaddr.sun_family = AF_UNIX;
1042: if (strlcpy(sunaddr.sun_path, path, sizeof(sunaddr.sun_path)) >= sizeof(sunaddr.sun_path)) {
1043: error("%s: \"%s\" too long for Unix domain socket", __func__,
1044: path);
1045: errno = ENAMETOOLONG;
1046: return -1;
1047: }
1048:
1049: sock = socket(PF_UNIX, SOCK_STREAM, 0);
1050: if (sock < 0) {
1051: saved_errno = errno;
1052: error("socket: %.100s", strerror(errno));
1053: errno = saved_errno;
1054: return -1;
1055: }
1056: if (unlink_first == 1) {
1057: if (unlink(path) != 0 && errno != ENOENT)
1058: error("unlink(%s): %.100s", path, strerror(errno));
1059: }
1060: if (bind(sock, (struct sockaddr *)&sunaddr, sizeof(sunaddr)) < 0) {
1061: saved_errno = errno;
1062: error("bind: %.100s", strerror(errno));
1063: close(sock);
1064: error("%s: cannot bind to path: %s", __func__, path);
1065: errno = saved_errno;
1066: return -1;
1067: }
1068: if (listen(sock, backlog) < 0) {
1069: saved_errno = errno;
1070: error("listen: %.100s", strerror(errno));
1071: close(sock);
1072: unlink(path);
1073: error("%s: cannot listen on path: %s", __func__, path);
1074: errno = saved_errno;
1075: return -1;
1076: }
1077: return sock;
1.85 stevesk 1078: }