1 /*
2  * Copyright (c) 2021, 2022 Omar Polo <op@omarpolo.com>
3  *
4  * Permission to use, copy, modify, and distribute this software for any
5  * purpose with or without fee is hereby granted, provided that the above
6  * copyright notice and this permission notice appear in all copies.
7  *
8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15  */
16 
17 #include <sys/types.h>
18 #include <sys/stat.h>
19 #include <sys/socket.h>
20 #include <sys/wait.h>
21 
22 #include <ctype.h>
23 #include <errno.h>
24 #include <event.h>
25 #include <fcntl.h>
26 #include <limits.h>
27 #include <netdb.h>
28 #include <signal.h>
29 #include <stdio.h>
30 #include <stdlib.h>
31 #include <string.h>
32 #include <syslog.h>
33 #include <unistd.h>
34 
35 #include "log.h"
36 
37 #ifndef SSH_PATH
38 #define SSH_PATH "/usr/bin/ssh"
39 #endif
40 
41 #define MAXSOCK 32
42 #define BACKOFF 1
43 #define RETRIES 16
44 
45 #ifndef __OpenBSD__
46 #define pledge(p, e) 0
47 #endif
48 
49 const char	*addr;		/* our addr */
50 const char	*ssh_tflag;
51 const char	*ssh_dest;
52 
53 char		 ssh_host[256];
54 char		 ssh_port[16];
55 
56 struct event	 sockev[MAXSOCK];
57 int		 socks[MAXSOCK];
58 int		 nsock;
59 
60 int		 debug;
61 int		 verbose;
62 
63 struct event	 sighupev;
64 struct event	 sigintev;
65 struct event	 sigtermev;
66 struct event	 sigchldev;
67 struct event	 siginfoev;
68 
69 struct timeval	 timeout = {600, 0}; /* 10 minutes */
70 struct event	 timeoutev;
71 
72 pid_t		 ssh_pid = -1;
73 
74 int		 conn;
75 
76 struct conn {
77 	int			 ntentative;
78 	struct timeval		 retry;
79 	struct event		 waitev;
80 	int			 source;
81 	struct bufferevent	*sourcebev;
82 	int			 to;
83 	struct bufferevent	*tobev;
84 };
85 
86 static void
87 sig_handler(int sig, short event, void *data)
88 {
89 	int status;
90 
91 	switch (sig) {
92 	case SIGHUP:
93 	case SIGINT:
94 	case SIGTERM:
95 		log_info("quitting");
96 		event_loopbreak();
97 		break;
98 	case SIGCHLD:
99 		if (waitpid(ssh_pid, &status, WNOHANG) == -1)
100 			fatal("waitpid");
101 		ssh_pid = -1;
102 		break;
103 #ifdef SIGINFO
104 	case SIGINFO:
105 #else
106 	case SIGUSR1:
107 #endif
108 		log_info("connections: %d", conn);
109 	}
110 }
111 
112 static int
113 spawn_ssh(void)
114 {
115 	log_debug("spawning ssh");
116 
117 	switch (ssh_pid = fork()) {
118 	case -1:
119 		log_warnx("fork");
120 		return -1;
121 	case 0:
122 		execl(SSH_PATH, "ssh", "-L", ssh_tflag, "-NTq", ssh_dest,
123 		    NULL);
124 		fatal("exec");
125 	default:
126 		return 0;
127 	}
128 }
129 
130 static void
131 conn_free(struct conn *c)
132 {
133 	if (c->sourcebev != NULL)
134 		bufferevent_free(c->sourcebev);
135 	if (c->tobev != NULL)
136 		bufferevent_free(c->tobev);
137 
138 	if (evtimer_pending(&c->waitev, NULL))
139 		evtimer_del(&c->waitev);
140 
141 	close(c->source);
142 	if (c->to != -1)
143 		close(c->to);
144 
145 	free(c);
146 }
147 
148 static void
149 killing_time(int fd, short event, void *data)
150 {
151 	if (ssh_pid == -1)
152 		return;
153 
154 	log_debug("timeout expired, killing ssh (%d)", ssh_pid);
155 	kill(ssh_pid, SIGTERM);
156 	ssh_pid = -1;
157 }
158 
159 static void
160 nopcb(struct bufferevent *bev, void *d)
161 {
162 	return;
163 }
164 
165 static void
166 sreadcb(struct bufferevent *bev, void *d)
167 {
168 	struct conn *c = d;
169 
170 	bufferevent_write_buffer(c->tobev, EVBUFFER_INPUT(bev));
171 }
172 
173 static void
174 treadcb(struct bufferevent *bev, void *d)
175 {
176 	struct conn *c = d;
177 
178 	bufferevent_write_buffer(c->sourcebev, EVBUFFER_INPUT(bev));
179 }
180 
181 static void
182 errcb(struct bufferevent *bev, short event, void *d)
183 {
184 	struct conn *c = d;
185 
186 	log_info("closing connection (event=%x)", event);
187 
188 	conn_free(c);
189 
190 	if (--conn == 0) {
191 		log_debug("scheduling ssh termination (%llds)",
192 		    (long long)timeout.tv_sec);
193 		if (timeout.tv_sec != 0) {
194 			evtimer_set(&timeoutev, killing_time, NULL);
195 			evtimer_add(&timeoutev, &timeout);
196 		}
197 	}
198 }
199 
200 static int
201 connect_to_ssh(void)
202 {
203 	struct addrinfo hints, *res, *res0;
204 	int r, saved_errno, sock;
205 	const char *cause;
206 
207 	memset(&hints, 0, sizeof(hints));
208 	hints.ai_family = AF_UNSPEC;
209 	hints.ai_socktype = SOCK_STREAM;
210 
211 	r = getaddrinfo(ssh_host, ssh_port, &hints, &res0);
212 	if (r != 0) {
213 		log_warnx("getaddrinfo(\"%s\", \"%s\"): %s",
214 		    ssh_host, ssh_port, gai_strerror(r));
215 		return -1;
216 	}
217 
218 	for (res = res0; res; res = res->ai_next) {
219 		sock = socket(res->ai_family, res->ai_socktype,
220 		    res->ai_protocol);
221 		if (sock == -1) {
222 			cause = "socket";
223 			continue;
224 		}
225 
226 		if (connect(sock, res->ai_addr, res->ai_addrlen) == -1) {
227 			cause = "connect";
228 			saved_errno = errno;
229 			close(sock);
230 			errno = saved_errno;
231 			sock = -1;
232 			continue;
233 		}
234 
235 		break;
236 	}
237 
238 	if (sock == -1)
239 		log_warn("%s", cause);
240 
241 	freeaddrinfo(res0);
242 	return sock;
243 }
244 
245 static void
246 try_to_connect(int fd, short event, void *d)
247 {
248 	struct conn *c = d;
249 
250 	/* ssh may have died in the meantime */
251 	if (ssh_pid == -1) {
252 		conn_free(c);
253 		return;
254 	}
255 
256 	c->ntentative++;
257 	log_info("trying to connect to %s:%s (%d/%d)", ssh_host, ssh_port,
258 	    c->ntentative, RETRIES);
259 
260 	if ((c->to = connect_to_ssh()) == -1) {
261 		if (c->ntentative == RETRIES) {
262 			log_warnx("giving up connecting");
263 			conn_free(c);
264 			return;
265 		}
266 
267 		evtimer_set(&c->waitev, try_to_connect, c);
268 		evtimer_add(&c->waitev, &c->retry);
269 		return;
270 	}
271 
272 	log_info("connected!");
273 
274 	c->sourcebev = bufferevent_new(c->source, sreadcb, nopcb, errcb, c);
275 	c->tobev = bufferevent_new(c->to, treadcb, nopcb, errcb, c);
276 	if (c->sourcebev == NULL || c->tobev == NULL) {
277 		log_warn("bufferevent_new");
278 		conn_free(c);
279 		return;
280 	}
281 
282 	bufferevent_enable(c->sourcebev, EV_READ|EV_WRITE);
283 	bufferevent_enable(c->tobev, EV_READ|EV_WRITE);
284 }
285 
286 static void
287 do_accept(int fd, short event, void *data)
288 {
289 	struct conn *c;
290 	int s;
291 
292 	log_debug("incoming connection");
293 
294 	if (evtimer_pending(&timeoutev, NULL))
295 		evtimer_del(&timeoutev);
296 
297 	if ((s = accept(fd, NULL, 0)) == -1)
298 		fatal("accept");
299 
300 	conn++;
301 
302 	if (ssh_pid == -1 && spawn_ssh() == -1) {
303 		close(s);
304 		return;
305 	}
306 
307 	if ((c = calloc(1, sizeof(*c))) == NULL) {
308 		log_warn("calloc");
309 		close(s);
310 		return;
311 	}
312 
313 	c->source = s;
314 	c->to = -1;
315 	c->retry.tv_sec = BACKOFF;
316 	evtimer_set(&c->waitev, try_to_connect, c);
317 	evtimer_add(&c->waitev, &c->retry);
318 }
319 
320 static const char *
321 copysec(const char *s, char *d, size_t len)
322 {
323 	const char *c;
324 
325 	if ((c = strchr(s, ':')) == NULL)
326 		return NULL;
327 	if ((size_t)(c - s) >= len-1)
328 		return NULL;
329 	memset(d, 0, len);
330 	memcpy(d, s, c - s);
331 	return c;
332 }
333 
334 static void
335 bind_socket(void)
336 {
337 	struct addrinfo hints, *res, *res0;
338 	int v, r, saved_errno;
339 	char host[64];
340 	const char *c, *h, *port, *cause;
341 
342 	if ((c = strchr(addr, ':')) == NULL) {
343 		h = NULL;
344 		port = addr;
345 	} else {
346 		if ((c = copysec(addr, host, sizeof(host))) == NULL)
347 			fatalx("name too long: %s", addr);
348 
349 		h = host;
350 		port = c+1;
351 	}
352 
353 	memset(&hints, 0, sizeof(hints));
354 	hints.ai_family = AF_UNSPEC;
355 	hints.ai_socktype = SOCK_STREAM;
356 	hints.ai_flags = AI_PASSIVE;
357 
358 	r = getaddrinfo(h, port, &hints, &res0);
359 	if (r != 0)
360 		fatalx("getaddrinfo(%s): %s", addr, gai_strerror(r));
361 
362 	for (res = res0; res && nsock < MAXSOCK; res = res->ai_next) {
363 		socks[nsock] = socket(res->ai_family, res->ai_socktype,
364 		    res->ai_protocol);
365 		if (socks[nsock] == -1) {
366 			cause = "socket";
367 			continue;
368 		}
369 
370 		if (bind(socks[nsock], res->ai_addr, res->ai_addrlen) == -1) {
371 			cause = "bind";
372 			saved_errno = errno;
373 			close(socks[nsock]);
374 			errno = saved_errno;
375 			continue;
376 		}
377 
378 		v = 1;
379 		if (setsockopt(socks[nsock], SOL_SOCKET, SO_REUSEADDR, &v,
380 		    sizeof(v)) == -1)
381 			fatal("setsockopt(SO_REUSEADDR)");
382 
383 		v = 1;
384 		if (setsockopt(socks[nsock], SOL_SOCKET, SO_REUSEPORT, &v,
385 		    sizeof(v)) == -1)
386 			fatal("setsockopt(SO_REUSEPORT)");
387 
388 		listen(socks[nsock], 5);
389 
390 		nsock++;
391 	}
392 	if (nsock == 0)
393 		fatal("%s", cause);
394 
395 	freeaddrinfo(res0);
396 }
397 
398 static void
399 parse_sshaddr(void)
400 {
401 	const char *c;
402 
403 	if (isdigit((unsigned char)*ssh_tflag)) {
404 		strlcpy(ssh_host, "localhost", sizeof(ssh_host));
405 		if (copysec(ssh_tflag, ssh_port, sizeof(ssh_port)) == NULL)
406 			goto err;
407 		return;
408 	}
409 
410 	if ((c = copysec(ssh_tflag, ssh_host, sizeof(ssh_host))) == NULL)
411 		goto err;
412 	if (copysec(c+1, ssh_port, sizeof(ssh_port)) == NULL)
413 		goto err;
414 	return;
415 
416 err:
417 	fatal("wrong value for -B");
418 }
419 
420 static void __dead
421 usage(void)
422 {
423 	fprintf(stderr, "usage: %s [-dv] -B sshaddr -b addr [-t timeout]"
424 	    " destination\n", getprogname());
425 	exit(1);
426 }
427 
428 int
429 main(int argc, char **argv)
430 {
431 	int ch, i, fd;
432 	const char *errstr;
433 	struct stat sb;
434 
435 	/*
436 	 * Ensure we have fds 0-2 open so that we have no issue with
437 	 * calling bind_socket before daemon(3).
438 	 */
439 	for (i = 0; i < 3; ++i) {
440 		if (fstat(i, &sb) == -1) {
441 			if ((fd = open("/dev/null", O_RDWR)) != -1) {
442 				if (dup2(fd, i) == -1)
443 					exit(1);
444 				if (fd > i)
445 					close(fd);
446 			} else
447 				exit(1);
448 		}
449 	}
450 
451 	log_init(1, LOG_DAEMON);
452 	log_setverbose(1);
453 
454 	while ((ch = getopt(argc, argv, "B:b:dt:v")) != -1) {
455 		switch (ch) {
456 		case 'B':
457 			ssh_tflag = optarg;
458 			parse_sshaddr();
459 			break;
460 		case 'b':
461 			addr = optarg;
462 			break;
463 		case 'd':
464 			debug = 1;
465 			break;
466 		case 't':
467 			timeout.tv_sec = strtonum(optarg, 0, INT_MAX, &errstr);
468 			if (errstr != NULL)
469 				fatalx("timeout is %s: %s", errstr, optarg);
470 			break;
471 		case 'v':
472 			verbose = 1;
473 			break;
474 		default:
475 			usage();
476 		}
477 	}
478 	argc -= optind;
479 	argv += optind;
480 
481 	if (argc != 1 || addr == NULL || ssh_tflag == NULL)
482 		usage();
483 
484 	ssh_dest = argv[0];
485 
486 	bind_socket();
487 
488 	log_init(debug, LOG_DAEMON);
489 	log_setverbose(verbose);
490 
491 	if (!debug)
492 		daemon(1, 0);
493 
494 	signal(SIGPIPE, SIG_IGN);
495 
496 	event_init();
497 
498 	/* initialize the timer */
499 	evtimer_set(&timeoutev, killing_time, NULL);
500 
501 	signal_set(&sighupev, SIGHUP, sig_handler, NULL);
502 	signal_set(&sigintev, SIGINT, sig_handler, NULL);
503 	signal_set(&sigtermev, SIGTERM, sig_handler, NULL);
504 	signal_set(&sigchldev, SIGCHLD, sig_handler, NULL);
505 #ifdef SIGINFO
506 	signal_set(&siginfoev, SIGINFO, sig_handler, NULL);
507 #else
508 	signal_set(&siginfoev, SIGUSR1, sig_handler, NULL);
509 #endif
510 
511 	signal_add(&sighupev, NULL);
512 	signal_add(&sigintev, NULL);
513 	signal_add(&sigtermev, NULL);
514 	signal_add(&sigchldev, NULL);
515 	signal_add(&siginfoev, NULL);
516 
517 	for (i = 0; i < nsock; ++i) {
518 		event_set(&sockev[i], socks[i], EV_READ|EV_PERSIST,
519 		    do_accept, NULL);
520 		event_add(&sockev[i], NULL);
521 	}
522 
523 	/*
524 	 * dns, inet: bind the socket and connect to the childs.
525 	 * proc, exec: execute ssh on demand.
526 	 */
527 	if (pledge("stdio dns inet proc exec", NULL) == -1)
528 		fatal("pledge");
529 
530 	log_info("starting");
531 	event_dispatch();
532 
533 	if (ssh_pid != -1)
534 		kill(ssh_pid, SIGINT);
535 
536 	return 0;
537 }