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