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