faithd.c revision 1.30 1 1.30 itojun /* $NetBSD: faithd.c,v 1.30 2003/09/02 22:57:29 itojun Exp $ */
2 1.30 itojun /* $KAME: faithd.c,v 1.62 2003/08/19 21:20:33 itojun Exp $ */
3 1.1 itojun
4 1.1 itojun /*
5 1.1 itojun * Copyright (C) 1997 and 1998 WIDE Project.
6 1.1 itojun * All rights reserved.
7 1.10 itojun *
8 1.1 itojun * Redistribution and use in source and binary forms, with or without
9 1.1 itojun * modification, are permitted provided that the following conditions
10 1.1 itojun * are met:
11 1.1 itojun * 1. Redistributions of source code must retain the above copyright
12 1.1 itojun * notice, this list of conditions and the following disclaimer.
13 1.1 itojun * 2. Redistributions in binary form must reproduce the above copyright
14 1.1 itojun * notice, this list of conditions and the following disclaimer in the
15 1.1 itojun * documentation and/or other materials provided with the distribution.
16 1.1 itojun * 3. Neither the name of the project nor the names of its contributors
17 1.1 itojun * may be used to endorse or promote products derived from this software
18 1.1 itojun * without specific prior written permission.
19 1.10 itojun *
20 1.1 itojun * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
21 1.1 itojun * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22 1.1 itojun * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
23 1.1 itojun * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
24 1.1 itojun * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
25 1.1 itojun * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
26 1.1 itojun * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
27 1.1 itojun * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28 1.1 itojun * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
29 1.1 itojun * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
30 1.1 itojun * SUCH DAMAGE.
31 1.1 itojun */
32 1.1 itojun
33 1.1 itojun /*
34 1.1 itojun * User level translator from IPv6 to IPv4.
35 1.1 itojun *
36 1.1 itojun * Usage: faithd [<port> <progpath> <arg1(progname)> <arg2> ...]
37 1.1 itojun * e.g. faithd telnet /usr/local/v6/sbin/telnetd telnetd
38 1.1 itojun */
39 1.1 itojun
40 1.1 itojun #include <sys/param.h>
41 1.1 itojun #include <sys/types.h>
42 1.1 itojun #include <sys/sysctl.h>
43 1.1 itojun #include <sys/socket.h>
44 1.1 itojun #include <sys/wait.h>
45 1.1 itojun #include <sys/stat.h>
46 1.1 itojun #include <sys/time.h>
47 1.1 itojun #include <sys/ioctl.h>
48 1.1 itojun
49 1.30 itojun #include <poll.h>
50 1.1 itojun #include <stdio.h>
51 1.1 itojun #include <stdlib.h>
52 1.1 itojun #include <stdarg.h>
53 1.1 itojun #include <string.h>
54 1.1 itojun #include <syslog.h>
55 1.1 itojun #include <unistd.h>
56 1.1 itojun #include <errno.h>
57 1.1 itojun #include <signal.h>
58 1.1 itojun #include <fcntl.h>
59 1.1 itojun #include <termios.h>
60 1.1 itojun
61 1.1 itojun #include <net/if_types.h>
62 1.1 itojun #ifdef IFT_FAITH
63 1.1 itojun # define USE_ROUTE
64 1.1 itojun # include <net/if.h>
65 1.1 itojun # include <net/route.h>
66 1.1 itojun # include <net/if_dl.h>
67 1.1 itojun #endif
68 1.1 itojun
69 1.1 itojun #include <netinet/in.h>
70 1.1 itojun #include <arpa/inet.h>
71 1.1 itojun #include <netdb.h>
72 1.9 itojun #include <ifaddrs.h>
73 1.1 itojun
74 1.1 itojun #include "faithd.h"
75 1.17 itojun #include "prefix.h"
76 1.1 itojun
77 1.1 itojun char *serverpath = NULL;
78 1.1 itojun char *serverarg[MAXARGV + 1];
79 1.1 itojun static char *faithdname = NULL;
80 1.1 itojun char logname[BUFSIZ];
81 1.7 itojun char procname[BUFSIZ];
82 1.1 itojun struct myaddrs {
83 1.1 itojun struct myaddrs *next;
84 1.1 itojun struct sockaddr *addr;
85 1.1 itojun };
86 1.1 itojun struct myaddrs *myaddrs = NULL;
87 1.20 itojun static const char *service;
88 1.1 itojun #ifdef USE_ROUTE
89 1.1 itojun static int sockfd = 0;
90 1.1 itojun #endif
91 1.1 itojun int dflag = 0;
92 1.1 itojun static int pflag = 0;
93 1.12 itojun static int inetd = 0;
94 1.17 itojun static char *configfile = NULL;
95 1.1 itojun
96 1.1 itojun int main __P((int, char **));
97 1.12 itojun static int inetd_main __P((int, char **));
98 1.12 itojun static int daemon_main __P((int, char **));
99 1.1 itojun static void play_service __P((int));
100 1.1 itojun static void play_child __P((int, struct sockaddr *));
101 1.1 itojun static int faith_prefix __P((struct sockaddr *));
102 1.1 itojun static int map6to4 __P((struct sockaddr_in6 *, struct sockaddr_in *));
103 1.1 itojun static void sig_child __P((int));
104 1.1 itojun static void sig_terminate __P((int));
105 1.1 itojun static void start_daemon __P((void));
106 1.15 itojun static void exit_stderr __P((const char *, ...))
107 1.15 itojun __attribute__((__format__(__printf__, 1, 2)));
108 1.1 itojun static void grab_myaddrs __P((void));
109 1.1 itojun static void free_myaddrs __P((void));
110 1.1 itojun static void update_myaddrs __P((void));
111 1.1 itojun static void usage __P((void));
112 1.1 itojun
113 1.1 itojun int
114 1.12 itojun main(int argc, char **argv)
115 1.1 itojun {
116 1.1 itojun
117 1.1 itojun /*
118 1.1 itojun * Initializing stuff
119 1.1 itojun */
120 1.1 itojun
121 1.1 itojun faithdname = strrchr(argv[0], '/');
122 1.1 itojun if (faithdname)
123 1.1 itojun faithdname++;
124 1.1 itojun else
125 1.1 itojun faithdname = argv[0];
126 1.1 itojun
127 1.12 itojun if (strcmp(faithdname, "faithd") != 0) {
128 1.12 itojun inetd = 1;
129 1.12 itojun return inetd_main(argc, argv);
130 1.12 itojun } else
131 1.12 itojun return daemon_main(argc, argv);
132 1.12 itojun }
133 1.12 itojun
134 1.12 itojun static int
135 1.12 itojun inetd_main(int argc, char **argv)
136 1.12 itojun {
137 1.12 itojun char path[MAXPATHLEN];
138 1.12 itojun struct sockaddr_storage me;
139 1.12 itojun struct sockaddr_storage from;
140 1.28 itojun socklen_t melen, fromlen;
141 1.12 itojun int i;
142 1.12 itojun int error;
143 1.12 itojun const int on = 1;
144 1.12 itojun char sbuf[NI_MAXSERV], snum[NI_MAXSERV];
145 1.12 itojun
146 1.17 itojun if (config_load(configfile) < 0 && configfile) {
147 1.17 itojun exit_failure("could not load config file");
148 1.17 itojun /*NOTREACHED*/
149 1.17 itojun }
150 1.17 itojun
151 1.12 itojun if (strrchr(argv[0], '/') == NULL)
152 1.12 itojun snprintf(path, sizeof(path), "%s/%s", DEFAULT_DIR, argv[0]);
153 1.12 itojun else
154 1.12 itojun snprintf(path, sizeof(path), "%s", argv[0]);
155 1.12 itojun
156 1.12 itojun #ifdef USE_ROUTE
157 1.12 itojun grab_myaddrs();
158 1.12 itojun
159 1.12 itojun sockfd = socket(PF_ROUTE, SOCK_RAW, PF_UNSPEC);
160 1.12 itojun if (sockfd < 0) {
161 1.20 itojun exit_failure("socket(PF_ROUTE): %s", strerror(errno));
162 1.12 itojun /*NOTREACHED*/
163 1.12 itojun }
164 1.12 itojun #endif
165 1.12 itojun
166 1.12 itojun melen = sizeof(me);
167 1.17 itojun if (getsockname(STDIN_FILENO, (struct sockaddr *)&me, &melen) < 0) {
168 1.20 itojun exit_failure("getsockname: %s", strerror(errno));
169 1.17 itojun /*NOTREACHED*/
170 1.17 itojun }
171 1.12 itojun fromlen = sizeof(from);
172 1.17 itojun if (getpeername(STDIN_FILENO, (struct sockaddr *)&from, &fromlen) < 0) {
173 1.20 itojun exit_failure("getpeername: %s", strerror(errno));
174 1.17 itojun /*NOTREACHED*/
175 1.17 itojun }
176 1.12 itojun if (getnameinfo((struct sockaddr *)&me, melen, NULL, 0,
177 1.12 itojun sbuf, sizeof(sbuf), NI_NUMERICHOST) == 0)
178 1.12 itojun service = sbuf;
179 1.12 itojun else
180 1.12 itojun service = DEFAULT_PORT_NAME;
181 1.12 itojun if (getnameinfo((struct sockaddr *)&me, melen, NULL, 0,
182 1.12 itojun snum, sizeof(snum), NI_NUMERICHOST) != 0)
183 1.12 itojun snprintf(snum, sizeof(snum), "?");
184 1.12 itojun
185 1.12 itojun snprintf(logname, sizeof(logname), "faithd %s", snum);
186 1.12 itojun snprintf(procname, sizeof(procname), "accepting port %s", snum);
187 1.12 itojun openlog(logname, LOG_PID | LOG_NOWAIT, LOG_DAEMON);
188 1.12 itojun
189 1.17 itojun if (argc >= MAXARGV) {
190 1.14 itojun exit_failure("too many arguments");
191 1.17 itojun /*NOTREACHED*/
192 1.17 itojun }
193 1.12 itojun serverarg[0] = serverpath = path;
194 1.12 itojun for (i = 1; i < argc; i++)
195 1.12 itojun serverarg[i] = argv[i];
196 1.12 itojun serverarg[i] = NULL;
197 1.12 itojun
198 1.12 itojun error = setsockopt(STDIN_FILENO, SOL_SOCKET, SO_OOBINLINE, &on,
199 1.12 itojun sizeof(on));
200 1.17 itojun if (error < 0) {
201 1.20 itojun exit_failure("setsockopt(SO_OOBINLINE): %s", strerror(errno));
202 1.17 itojun /*NOTREACHED*/
203 1.17 itojun }
204 1.12 itojun
205 1.12 itojun play_child(STDIN_FILENO, (struct sockaddr *)&from);
206 1.12 itojun exit_failure("should not reach here");
207 1.12 itojun return 0; /*dummy!*/
208 1.12 itojun }
209 1.12 itojun
210 1.12 itojun static int
211 1.12 itojun daemon_main(int argc, char **argv)
212 1.12 itojun {
213 1.12 itojun struct addrinfo hints, *res;
214 1.12 itojun int s_wld, error, i, serverargc, on = 1;
215 1.12 itojun int family = AF_INET6;
216 1.12 itojun int c;
217 1.12 itojun
218 1.26 itojun while ((c = getopt(argc, argv, "df:p")) != -1) {
219 1.1 itojun switch (c) {
220 1.1 itojun case 'd':
221 1.1 itojun dflag++;
222 1.1 itojun break;
223 1.17 itojun case 'f':
224 1.17 itojun configfile = optarg;
225 1.17 itojun break;
226 1.1 itojun case 'p':
227 1.1 itojun pflag++;
228 1.1 itojun break;
229 1.1 itojun default:
230 1.1 itojun usage();
231 1.14 itojun /*NOTREACHED*/
232 1.1 itojun }
233 1.1 itojun }
234 1.1 itojun argc -= optind;
235 1.1 itojun argv += optind;
236 1.1 itojun
237 1.17 itojun if (config_load(configfile) < 0 && configfile) {
238 1.17 itojun exit_failure("could not load config file");
239 1.17 itojun /*NOTREACHED*/
240 1.17 itojun }
241 1.17 itojun
242 1.1 itojun
243 1.1 itojun #ifdef USE_ROUTE
244 1.1 itojun grab_myaddrs();
245 1.1 itojun #endif
246 1.1 itojun
247 1.1 itojun switch (argc) {
248 1.1 itojun case 0:
249 1.14 itojun usage();
250 1.14 itojun /*NOTREACHED*/
251 1.1 itojun default:
252 1.1 itojun serverargc = argc - NUMARG;
253 1.12 itojun if (serverargc >= MAXARGV)
254 1.14 itojun exit_stderr("too many arguments");
255 1.1 itojun
256 1.29 itojun serverpath = strdup(argv[NUMPRG]);
257 1.21 itojun if (!serverpath)
258 1.21 itojun exit_stderr("not enough core");
259 1.1 itojun for (i = 0; i < serverargc; i++) {
260 1.29 itojun serverarg[i] = strdup(argv[i + NUMARG]);
261 1.21 itojun if (!serverarg[i])
262 1.21 itojun exit_stderr("not enough core");
263 1.1 itojun }
264 1.1 itojun serverarg[i] = NULL;
265 1.1 itojun /* fall throuth */
266 1.1 itojun case 1: /* no local service */
267 1.1 itojun service = argv[NUMPRT];
268 1.1 itojun break;
269 1.1 itojun }
270 1.1 itojun
271 1.23 itojun start_daemon();
272 1.23 itojun
273 1.1 itojun /*
274 1.1 itojun * Opening wild card socket for this service.
275 1.1 itojun */
276 1.1 itojun
277 1.1 itojun memset(&hints, 0, sizeof(hints));
278 1.1 itojun hints.ai_flags = AI_PASSIVE;
279 1.1 itojun hints.ai_family = family;
280 1.1 itojun hints.ai_socktype = SOCK_STREAM;
281 1.29 itojun hints.ai_protocol = IPPROTO_TCP; /* SCTP? */
282 1.1 itojun error = getaddrinfo(NULL, service, &hints, &res);
283 1.10 itojun if (error)
284 1.23 itojun exit_failure("getaddrinfo: %s", gai_strerror(error));
285 1.1 itojun
286 1.1 itojun s_wld = socket(res->ai_family, res->ai_socktype, res->ai_protocol);
287 1.1 itojun if (s_wld == -1)
288 1.23 itojun exit_failure("socket: %s", strerror(errno));
289 1.1 itojun
290 1.1 itojun #ifdef IPV6_FAITH
291 1.1 itojun if (res->ai_family == AF_INET6) {
292 1.1 itojun error = setsockopt(s_wld, IPPROTO_IPV6, IPV6_FAITH, &on, sizeof(on));
293 1.1 itojun if (error == -1)
294 1.23 itojun exit_failure("setsockopt(IPV6_FAITH): %s",
295 1.20 itojun strerror(errno));
296 1.1 itojun }
297 1.1 itojun #endif
298 1.1 itojun
299 1.1 itojun error = setsockopt(s_wld, SOL_SOCKET, SO_REUSEADDR, &on, sizeof(on));
300 1.1 itojun if (error == -1)
301 1.23 itojun exit_failure("setsockopt(SO_REUSEADDR): %s", strerror(errno));
302 1.1 itojun
303 1.1 itojun error = setsockopt(s_wld, SOL_SOCKET, SO_OOBINLINE, &on, sizeof(on));
304 1.1 itojun if (error == -1)
305 1.23 itojun exit_failure("setsockopt(SO_OOBINLINE): %s", strerror(errno));
306 1.1 itojun
307 1.27 itojun #ifdef IPV6_V6ONLY
308 1.27 itojun error = setsockopt(s_wld, IPPROTO_IPV6, IPV6_V6ONLY, &on, sizeof(on));
309 1.27 itojun if (error == -1)
310 1.27 itojun exit_failure("setsockopt(IPV6_V6ONLY): %s", strerror(errno));
311 1.27 itojun #endif
312 1.27 itojun
313 1.1 itojun error = bind(s_wld, (struct sockaddr *)res->ai_addr, res->ai_addrlen);
314 1.1 itojun if (error == -1)
315 1.23 itojun exit_failure("bind: %s", strerror(errno));
316 1.1 itojun
317 1.1 itojun error = listen(s_wld, 5);
318 1.1 itojun if (error == -1)
319 1.23 itojun exit_failure("listen: %s", strerror(errno));
320 1.1 itojun
321 1.1 itojun #ifdef USE_ROUTE
322 1.1 itojun sockfd = socket(PF_ROUTE, SOCK_RAW, PF_UNSPEC);
323 1.1 itojun if (sockfd < 0) {
324 1.23 itojun exit_failure("socket(PF_ROUTE): %s", strerror(errno));
325 1.1 itojun /*NOTREACHED*/
326 1.1 itojun }
327 1.1 itojun #endif
328 1.1 itojun
329 1.1 itojun /*
330 1.1 itojun * Everything is OK.
331 1.1 itojun */
332 1.1 itojun
333 1.7 itojun snprintf(logname, sizeof(logname), "faithd %s", service);
334 1.7 itojun snprintf(procname, sizeof(procname), "accepting port %s", service);
335 1.1 itojun openlog(logname, LOG_PID | LOG_NOWAIT, LOG_DAEMON);
336 1.17 itojun syslog(LOG_INFO, "Staring faith daemon for %s port", service);
337 1.1 itojun
338 1.1 itojun play_service(s_wld);
339 1.14 itojun /* NOTREACHED */
340 1.1 itojun exit(1); /*pacify gcc*/
341 1.1 itojun }
342 1.1 itojun
343 1.1 itojun static void
344 1.1 itojun play_service(int s_wld)
345 1.1 itojun {
346 1.1 itojun struct sockaddr_storage srcaddr;
347 1.28 itojun socklen_t len;
348 1.1 itojun int s_src;
349 1.1 itojun pid_t child_pid;
350 1.30 itojun struct pollfd pfd[2];
351 1.1 itojun int error;
352 1.1 itojun
353 1.1 itojun /*
354 1.1 itojun * Wait, accept, fork, faith....
355 1.1 itojun */
356 1.1 itojun again:
357 1.13 itojun setproctitle("%s", procname);
358 1.1 itojun
359 1.30 itojun pfd[0].fd = s_wld;
360 1.30 itojun pfd[0].events = POLLIN;
361 1.30 itojun pfd[1].fd = -1;
362 1.30 itojun pfd[1].revents = 0;
363 1.1 itojun #ifdef USE_ROUTE
364 1.1 itojun if (sockfd) {
365 1.30 itojun pfd[1].fd = sockfd;
366 1.30 itojun pfd[1].events = POLLIN;
367 1.1 itojun }
368 1.1 itojun #endif
369 1.1 itojun
370 1.30 itojun error = poll(pfd, sizeof(pfd)/sizeof(pfd[0]), 0);
371 1.1 itojun if (error < 0) {
372 1.1 itojun if (errno == EINTR)
373 1.1 itojun goto again;
374 1.20 itojun exit_failure("select: %s", strerror(errno));
375 1.1 itojun /*NOTREACHED*/
376 1.1 itojun }
377 1.1 itojun
378 1.1 itojun #ifdef USE_ROUTE
379 1.30 itojun if (pfd[1].revents & POLLIN)
380 1.30 itojun {
381 1.1 itojun update_myaddrs();
382 1.1 itojun }
383 1.1 itojun #endif
384 1.30 itojun if (pfd[0].revents & POLLIN)
385 1.30 itojun {
386 1.1 itojun len = sizeof(srcaddr);
387 1.27 itojun s_src = accept(s_wld, (struct sockaddr *)&srcaddr, &len);
388 1.24 itojun if (s_src < 0) {
389 1.24 itojun if (errno == ECONNABORTED)
390 1.24 itojun goto again;
391 1.20 itojun exit_failure("socket: %s", strerror(errno));
392 1.17 itojun /*NOTREACHED*/
393 1.27 itojun }
394 1.27 itojun if (srcaddr.ss_family == AF_INET6 &&
395 1.27 itojun IN6_IS_ADDR_V4MAPPED(&((struct sockaddr_in6 *)&srcaddr)->sin6_addr)) {
396 1.27 itojun close(s_src);
397 1.27 itojun syslog(LOG_ERR, "connection from IPv4 mapped address?");
398 1.27 itojun goto again;
399 1.17 itojun }
400 1.1 itojun
401 1.1 itojun child_pid = fork();
402 1.26 itojun
403 1.1 itojun if (child_pid == 0) {
404 1.1 itojun /* child process */
405 1.1 itojun close(s_wld);
406 1.1 itojun closelog();
407 1.1 itojun openlog(logname, LOG_PID | LOG_NOWAIT, LOG_DAEMON);
408 1.1 itojun play_child(s_src, (struct sockaddr *)&srcaddr);
409 1.1 itojun exit_failure("should never reach here");
410 1.17 itojun /*NOTREACHED*/
411 1.1 itojun } else {
412 1.1 itojun /* parent process */
413 1.1 itojun close(s_src);
414 1.1 itojun if (child_pid == -1)
415 1.1 itojun syslog(LOG_ERR, "can't fork");
416 1.1 itojun }
417 1.1 itojun }
418 1.1 itojun goto again;
419 1.1 itojun }
420 1.1 itojun
421 1.1 itojun static void
422 1.1 itojun play_child(int s_src, struct sockaddr *srcaddr)
423 1.1 itojun {
424 1.10 itojun struct sockaddr_storage dstaddr6;
425 1.1 itojun struct sockaddr_storage dstaddr4;
426 1.24 itojun char src[NI_MAXHOST];
427 1.24 itojun char dst6[NI_MAXHOST];
428 1.24 itojun char dst4[NI_MAXHOST];
429 1.28 itojun socklen_t len = sizeof(dstaddr6);
430 1.1 itojun int s_dst, error, hport, nresvport, on = 1;
431 1.1 itojun struct timeval tv;
432 1.2 itojun struct sockaddr *sa4;
433 1.17 itojun const struct config *conf;
434 1.1 itojun
435 1.1 itojun tv.tv_sec = 1;
436 1.1 itojun tv.tv_usec = 0;
437 1.1 itojun
438 1.1 itojun getnameinfo(srcaddr, srcaddr->sa_len,
439 1.1 itojun src, sizeof(src), NULL, 0, NI_NUMERICHOST);
440 1.1 itojun syslog(LOG_INFO, "accepted a client from %s", src);
441 1.1 itojun
442 1.1 itojun error = getsockname(s_src, (struct sockaddr *)&dstaddr6, &len);
443 1.17 itojun if (error == -1) {
444 1.20 itojun exit_failure("getsockname: %s", strerror(errno));
445 1.17 itojun /*NOTREACHED*/
446 1.17 itojun }
447 1.1 itojun
448 1.2 itojun getnameinfo((struct sockaddr *)&dstaddr6, len,
449 1.1 itojun dst6, sizeof(dst6), NULL, 0, NI_NUMERICHOST);
450 1.1 itojun syslog(LOG_INFO, "the client is connecting to %s", dst6);
451 1.1 itojun
452 1.1 itojun if (!faith_prefix((struct sockaddr *)&dstaddr6)) {
453 1.1 itojun if (serverpath) {
454 1.1 itojun /*
455 1.1 itojun * Local service
456 1.1 itojun */
457 1.1 itojun syslog(LOG_INFO, "executing local %s", serverpath);
458 1.12 itojun if (!inetd) {
459 1.12 itojun dup2(s_src, 0);
460 1.12 itojun close(s_src);
461 1.12 itojun dup2(0, 1);
462 1.12 itojun dup2(0, 2);
463 1.12 itojun }
464 1.1 itojun execv(serverpath, serverarg);
465 1.20 itojun syslog(LOG_ERR, "execv %s: %s", serverpath,
466 1.20 itojun strerror(errno));
467 1.1 itojun _exit(EXIT_FAILURE);
468 1.1 itojun } else {
469 1.1 itojun close(s_src);
470 1.1 itojun exit_success("no local service for %s", service);
471 1.1 itojun }
472 1.1 itojun }
473 1.1 itojun
474 1.1 itojun /*
475 1.1 itojun * Act as a translator
476 1.1 itojun */
477 1.1 itojun
478 1.2 itojun switch (((struct sockaddr *)&dstaddr6)->sa_family) {
479 1.2 itojun case AF_INET6:
480 1.1 itojun if (!map6to4((struct sockaddr_in6 *)&dstaddr6,
481 1.1 itojun (struct sockaddr_in *)&dstaddr4)) {
482 1.1 itojun close(s_src);
483 1.14 itojun exit_failure("map6to4 failed");
484 1.17 itojun /*NOTREACHED*/
485 1.1 itojun }
486 1.1 itojun syslog(LOG_INFO, "translating from v6 to v4");
487 1.2 itojun break;
488 1.2 itojun default:
489 1.1 itojun close(s_src);
490 1.14 itojun exit_failure("family not supported");
491 1.2 itojun /*NOTREACHED*/
492 1.1 itojun }
493 1.1 itojun
494 1.2 itojun sa4 = (struct sockaddr *)&dstaddr4;
495 1.2 itojun getnameinfo(sa4, sa4->sa_len,
496 1.1 itojun dst4, sizeof(dst4), NULL, 0, NI_NUMERICHOST);
497 1.17 itojun
498 1.17 itojun conf = config_match(srcaddr, sa4);
499 1.17 itojun if (!conf || !conf->permit) {
500 1.17 itojun close(s_src);
501 1.19 itojun if (conf) {
502 1.19 itojun exit_failure("translation to %s not permitted for %s",
503 1.19 itojun dst4, prefix_string(&conf->match));
504 1.19 itojun /*NOTREACHED*/
505 1.19 itojun } else {
506 1.19 itojun exit_failure("translation to %s not permitted", dst4);
507 1.19 itojun /*NOTREACHED*/
508 1.19 itojun }
509 1.17 itojun }
510 1.17 itojun
511 1.1 itojun syslog(LOG_INFO, "the translator is connecting to %s", dst4);
512 1.1 itojun
513 1.1 itojun setproctitle("port %s, %s -> %s", service, src, dst4);
514 1.1 itojun
515 1.2 itojun if (sa4->sa_family == AF_INET6)
516 1.1 itojun hport = ntohs(((struct sockaddr_in6 *)&dstaddr4)->sin6_port);
517 1.1 itojun else /* AF_INET */
518 1.1 itojun hport = ntohs(((struct sockaddr_in *)&dstaddr4)->sin_port);
519 1.1 itojun
520 1.25 itojun if (pflag)
521 1.2 itojun s_dst = rresvport_af(&nresvport, sa4->sa_family);
522 1.25 itojun else
523 1.25 itojun s_dst = socket(sa4->sa_family, SOCK_STREAM, 0);
524 1.17 itojun if (s_dst < 0) {
525 1.20 itojun exit_failure("socket: %s", strerror(errno));
526 1.17 itojun /*NOTREACHED*/
527 1.17 itojun }
528 1.17 itojun
529 1.17 itojun if (conf->src.a.ss_family) {
530 1.20 itojun if (bind(s_dst, (const struct sockaddr *)&conf->src.a,
531 1.17 itojun conf->src.a.ss_len) < 0) {
532 1.20 itojun exit_failure("bind: %s", strerror(errno));
533 1.17 itojun /*NOTREACHED*/
534 1.17 itojun }
535 1.17 itojun }
536 1.1 itojun
537 1.1 itojun error = setsockopt(s_dst, SOL_SOCKET, SO_OOBINLINE, &on, sizeof(on));
538 1.17 itojun if (error < 0) {
539 1.20 itojun exit_failure("setsockopt(SO_OOBINLINE): %s", strerror(errno));
540 1.17 itojun /*NOTREACHED*/
541 1.17 itojun }
542 1.1 itojun
543 1.1 itojun error = setsockopt(s_src, SOL_SOCKET, SO_SNDTIMEO, &tv, sizeof(tv));
544 1.17 itojun if (error < 0) {
545 1.20 itojun exit_failure("setsockopt(SO_SNDTIMEO): %s", strerror(errno));
546 1.17 itojun /*NOTREACHED*/
547 1.17 itojun }
548 1.1 itojun error = setsockopt(s_dst, SOL_SOCKET, SO_SNDTIMEO, &tv, sizeof(tv));
549 1.17 itojun if (error < 0) {
550 1.20 itojun exit_failure("setsockopt(SO_SNDTIMEO): %s", strerror(errno));
551 1.17 itojun /*NOTREACHED*/
552 1.17 itojun }
553 1.1 itojun
554 1.8 itojun error = connect(s_dst, sa4, sa4->sa_len);
555 1.17 itojun if (error < 0) {
556 1.20 itojun exit_failure("connect: %s", strerror(errno));
557 1.17 itojun /*NOTREACHED*/
558 1.17 itojun }
559 1.1 itojun
560 1.1 itojun switch (hport) {
561 1.1 itojun case FTP_PORT:
562 1.1 itojun ftp_relay(s_src, s_dst);
563 1.1 itojun break;
564 1.1 itojun default:
565 1.1 itojun tcp_relay(s_src, s_dst, service);
566 1.1 itojun break;
567 1.1 itojun }
568 1.1 itojun
569 1.1 itojun /* NOTREACHED */
570 1.1 itojun }
571 1.1 itojun
572 1.1 itojun /* 0: non faith, 1: faith */
573 1.1 itojun static int
574 1.1 itojun faith_prefix(struct sockaddr *dst)
575 1.1 itojun {
576 1.1 itojun #ifndef USE_ROUTE
577 1.1 itojun int mib[4], size;
578 1.1 itojun struct in6_addr faith_prefix;
579 1.1 itojun struct sockaddr_in6 *dst6 = (struct sockaddr_in *)dst;
580 1.1 itojun
581 1.1 itojun if (dst->sa_family != AF_INET6)
582 1.1 itojun return 0;
583 1.1 itojun
584 1.1 itojun mib[0] = CTL_NET;
585 1.1 itojun mib[1] = PF_INET6;
586 1.1 itojun mib[2] = IPPROTO_IPV6;
587 1.1 itojun mib[3] = IPV6CTL_FAITH_PREFIX;
588 1.1 itojun size = sizeof(struct in6_addr);
589 1.17 itojun if (sysctl(mib, 4, &faith_prefix, &size, NULL, 0) < 0) {
590 1.20 itojun exit_failure("sysctl: %s", strerror(errno));
591 1.17 itojun /*NOTREACHED*/
592 1.17 itojun }
593 1.1 itojun
594 1.2 itojun if (memcmp(dst, &faith_prefix,
595 1.2 itojun sizeof(struct in6_addr) - sizeof(struct in_addr) == 0) {
596 1.1 itojun return 1;
597 1.2 itojun }
598 1.1 itojun return 0;
599 1.1 itojun #else
600 1.1 itojun struct myaddrs *p;
601 1.1 itojun struct sockaddr_in6 *sin6;
602 1.1 itojun struct sockaddr_in *sin4;
603 1.3 itojun struct sockaddr_in6 *dst6;
604 1.3 itojun struct sockaddr_in *dst4;
605 1.3 itojun struct sockaddr_in dstmap;
606 1.3 itojun
607 1.4 itojun dst6 = (struct sockaddr_in6 *)dst;
608 1.3 itojun if (dst->sa_family == AF_INET6
609 1.3 itojun && IN6_IS_ADDR_V4MAPPED(&dst6->sin6_addr)) {
610 1.3 itojun /* ugly... */
611 1.3 itojun memset(&dstmap, 0, sizeof(dstmap));
612 1.3 itojun dstmap.sin_family = AF_INET;
613 1.3 itojun dstmap.sin_len = sizeof(dstmap);
614 1.3 itojun memcpy(&dstmap.sin_addr, &dst6->sin6_addr.s6_addr[12],
615 1.3 itojun sizeof(dstmap.sin_addr));
616 1.3 itojun dst = (struct sockaddr *)&dstmap;
617 1.3 itojun }
618 1.3 itojun
619 1.3 itojun dst6 = (struct sockaddr_in6 *)dst;
620 1.3 itojun dst4 = (struct sockaddr_in *)dst;
621 1.1 itojun
622 1.1 itojun for (p = myaddrs; p; p = p->next) {
623 1.1 itojun sin6 = (struct sockaddr_in6 *)p->addr;
624 1.1 itojun sin4 = (struct sockaddr_in *)p->addr;
625 1.1 itojun
626 1.3 itojun if (p->addr->sa_len != dst->sa_len
627 1.3 itojun || p->addr->sa_family != dst->sa_family)
628 1.3 itojun continue;
629 1.3 itojun
630 1.3 itojun switch (dst->sa_family) {
631 1.3 itojun case AF_INET6:
632 1.3 itojun if (sin6->sin6_scope_id == dst6->sin6_scope_id
633 1.5 itojun && IN6_ARE_ADDR_EQUAL(&sin6->sin6_addr, &dst6->sin6_addr))
634 1.1 itojun return 0;
635 1.3 itojun break;
636 1.3 itojun case AF_INET:
637 1.3 itojun if (sin4->sin_addr.s_addr == dst4->sin_addr.s_addr)
638 1.6 itojun return 0;
639 1.3 itojun break;
640 1.1 itojun }
641 1.1 itojun }
642 1.1 itojun return 1;
643 1.1 itojun #endif
644 1.1 itojun }
645 1.1 itojun
646 1.1 itojun /* 0: non faith, 1: faith */
647 1.1 itojun static int
648 1.1 itojun map6to4(struct sockaddr_in6 *dst6, struct sockaddr_in *dst4)
649 1.1 itojun {
650 1.1 itojun memset(dst4, 0, sizeof(*dst4));
651 1.1 itojun dst4->sin_len = sizeof(*dst4);
652 1.1 itojun dst4->sin_family = AF_INET;
653 1.1 itojun dst4->sin_port = dst6->sin6_port;
654 1.2 itojun memcpy(&dst4->sin_addr, &dst6->sin6_addr.s6_addr[12],
655 1.2 itojun sizeof(dst4->sin_addr));
656 1.1 itojun
657 1.1 itojun if (dst4->sin_addr.s_addr == INADDR_ANY
658 1.1 itojun || dst4->sin_addr.s_addr == INADDR_BROADCAST
659 1.14 itojun || IN_MULTICAST(ntohl(dst4->sin_addr.s_addr)))
660 1.1 itojun return 0;
661 1.1 itojun
662 1.1 itojun return 1;
663 1.1 itojun }
664 1.1 itojun
665 1.1 itojun
666 1.1 itojun static void
667 1.1 itojun sig_child(int sig)
668 1.1 itojun {
669 1.1 itojun int status;
670 1.1 itojun pid_t pid;
671 1.1 itojun
672 1.21 itojun while ((pid = wait3(&status, WNOHANG, (struct rusage *)0)) > 0)
673 1.21 itojun if (WEXITSTATUS(status))
674 1.26 itojun syslog(LOG_WARNING, "child %ld exit status 0x%x",
675 1.26 itojun (long)pid, status);
676 1.1 itojun }
677 1.1 itojun
678 1.1 itojun void
679 1.1 itojun sig_terminate(int sig)
680 1.1 itojun {
681 1.1 itojun syslog(LOG_INFO, "Terminating faith daemon");
682 1.1 itojun exit(EXIT_SUCCESS);
683 1.1 itojun }
684 1.1 itojun
685 1.1 itojun static void
686 1.1 itojun start_daemon(void)
687 1.1 itojun {
688 1.18 itojun #ifdef SA_NOCLDWAIT
689 1.18 itojun struct sigaction sa;
690 1.18 itojun #endif
691 1.18 itojun
692 1.1 itojun if (daemon(0, 0) == -1)
693 1.20 itojun exit_stderr("daemon: %s", strerror(errno));
694 1.1 itojun
695 1.18 itojun #ifdef SA_NOCLDWAIT
696 1.18 itojun memset(&sa, 0, sizeof(sa));
697 1.18 itojun sa.sa_handler = sig_child;
698 1.18 itojun sa.sa_flags = SA_NOCLDWAIT;
699 1.18 itojun sigemptyset(&sa.sa_mask);
700 1.18 itojun sigaction(SIGCHLD, &sa, (struct sigaction *)0);
701 1.18 itojun #else
702 1.17 itojun if (signal(SIGCHLD, sig_child) == SIG_ERR) {
703 1.20 itojun exit_failure("signal CHLD: %s", strerror(errno));
704 1.17 itojun /*NOTREACHED*/
705 1.17 itojun }
706 1.18 itojun #endif
707 1.1 itojun
708 1.17 itojun if (signal(SIGTERM, sig_terminate) == SIG_ERR) {
709 1.20 itojun exit_failure("signal TERM: %s", strerror(errno));
710 1.17 itojun /*NOTREACHED*/
711 1.17 itojun }
712 1.1 itojun }
713 1.1 itojun
714 1.14 itojun static void
715 1.14 itojun exit_stderr(const char *fmt, ...)
716 1.1 itojun {
717 1.1 itojun va_list ap;
718 1.1 itojun char buf[BUFSIZ];
719 1.1 itojun
720 1.1 itojun va_start(ap, fmt);
721 1.7 itojun vsnprintf(buf, sizeof(buf), fmt, ap);
722 1.1 itojun va_end(ap);
723 1.17 itojun fprintf(stderr, "%s\n", buf);
724 1.1 itojun exit(EXIT_FAILURE);
725 1.1 itojun }
726 1.1 itojun
727 1.1 itojun void
728 1.1 itojun exit_failure(const char *fmt, ...)
729 1.1 itojun {
730 1.1 itojun va_list ap;
731 1.1 itojun char buf[BUFSIZ];
732 1.1 itojun
733 1.1 itojun va_start(ap, fmt);
734 1.7 itojun vsnprintf(buf, sizeof(buf), fmt, ap);
735 1.1 itojun va_end(ap);
736 1.11 itojun syslog(LOG_ERR, "%s", buf);
737 1.1 itojun exit(EXIT_FAILURE);
738 1.1 itojun }
739 1.1 itojun
740 1.1 itojun void
741 1.1 itojun exit_success(const char *fmt, ...)
742 1.1 itojun {
743 1.1 itojun va_list ap;
744 1.1 itojun char buf[BUFSIZ];
745 1.1 itojun
746 1.1 itojun va_start(ap, fmt);
747 1.7 itojun vsnprintf(buf, sizeof(buf), fmt, ap);
748 1.1 itojun va_end(ap);
749 1.11 itojun syslog(LOG_INFO, "%s", buf);
750 1.1 itojun exit(EXIT_SUCCESS);
751 1.1 itojun }
752 1.1 itojun
753 1.1 itojun #ifdef USE_ROUTE
754 1.1 itojun static void
755 1.1 itojun grab_myaddrs()
756 1.1 itojun {
757 1.9 itojun struct ifaddrs *ifap, *ifa;
758 1.9 itojun struct myaddrs *p;
759 1.9 itojun struct sockaddr_in6 *sin6;
760 1.9 itojun
761 1.9 itojun if (getifaddrs(&ifap) != 0) {
762 1.9 itojun exit_failure("getifaddrs");
763 1.9 itojun /*NOTREACHED*/
764 1.9 itojun }
765 1.9 itojun
766 1.9 itojun for (ifa = ifap; ifa; ifa = ifa->ifa_next) {
767 1.9 itojun switch (ifa->ifa_addr->sa_family) {
768 1.9 itojun case AF_INET:
769 1.9 itojun case AF_INET6:
770 1.9 itojun break;
771 1.9 itojun default:
772 1.9 itojun continue;
773 1.9 itojun }
774 1.9 itojun
775 1.9 itojun p = (struct myaddrs *)malloc(sizeof(struct myaddrs) +
776 1.9 itojun ifa->ifa_addr->sa_len);
777 1.9 itojun if (!p) {
778 1.9 itojun exit_failure("not enough core");
779 1.9 itojun /*NOTREACHED*/
780 1.9 itojun }
781 1.9 itojun memcpy(p + 1, ifa->ifa_addr, ifa->ifa_addr->sa_len);
782 1.9 itojun p->next = myaddrs;
783 1.9 itojun p->addr = (struct sockaddr *)(p + 1);
784 1.9 itojun #ifdef __KAME__
785 1.9 itojun if (ifa->ifa_addr->sa_family == AF_INET6) {
786 1.9 itojun sin6 = (struct sockaddr_in6 *)p->addr;
787 1.9 itojun if (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr)
788 1.9 itojun || IN6_IS_ADDR_SITELOCAL(&sin6->sin6_addr)) {
789 1.9 itojun sin6->sin6_scope_id =
790 1.9 itojun ntohs(*(u_int16_t *)&sin6->sin6_addr.s6_addr[2]);
791 1.9 itojun sin6->sin6_addr.s6_addr[2] = 0;
792 1.9 itojun sin6->sin6_addr.s6_addr[3] = 0;
793 1.9 itojun }
794 1.9 itojun }
795 1.9 itojun #endif
796 1.9 itojun myaddrs = p;
797 1.9 itojun if (dflag) {
798 1.9 itojun char hbuf[NI_MAXHOST];
799 1.9 itojun getnameinfo(p->addr, p->addr->sa_len,
800 1.9 itojun hbuf, sizeof(hbuf), NULL, 0,
801 1.9 itojun NI_NUMERICHOST);
802 1.9 itojun syslog(LOG_INFO, "my interface: %s %s", hbuf,
803 1.9 itojun ifa->ifa_name);
804 1.9 itojun }
805 1.9 itojun }
806 1.9 itojun
807 1.9 itojun freeifaddrs(ifap);
808 1.1 itojun }
809 1.1 itojun
810 1.1 itojun static void
811 1.1 itojun free_myaddrs()
812 1.1 itojun {
813 1.1 itojun struct myaddrs *p, *q;
814 1.1 itojun
815 1.1 itojun p = myaddrs;
816 1.1 itojun while (p) {
817 1.1 itojun q = p->next;
818 1.1 itojun free(p);
819 1.1 itojun p = q;
820 1.1 itojun }
821 1.1 itojun myaddrs = NULL;
822 1.1 itojun }
823 1.1 itojun
824 1.1 itojun static void
825 1.1 itojun update_myaddrs()
826 1.1 itojun {
827 1.1 itojun char msg[BUFSIZ];
828 1.1 itojun int len;
829 1.1 itojun struct rt_msghdr *rtm;
830 1.1 itojun
831 1.1 itojun len = read(sockfd, msg, sizeof(msg));
832 1.1 itojun if (len < 0) {
833 1.1 itojun syslog(LOG_ERR, "read(PF_ROUTE) failed");
834 1.1 itojun return;
835 1.1 itojun }
836 1.1 itojun rtm = (struct rt_msghdr *)msg;
837 1.1 itojun if (len < 4 || len < rtm->rtm_msglen) {
838 1.1 itojun syslog(LOG_ERR, "read(PF_ROUTE) short read");
839 1.1 itojun return;
840 1.1 itojun }
841 1.1 itojun if (rtm->rtm_version != RTM_VERSION) {
842 1.1 itojun syslog(LOG_ERR, "routing socket version mismatch");
843 1.1 itojun close(sockfd);
844 1.1 itojun sockfd = 0;
845 1.1 itojun return;
846 1.1 itojun }
847 1.1 itojun switch (rtm->rtm_type) {
848 1.1 itojun case RTM_NEWADDR:
849 1.1 itojun case RTM_DELADDR:
850 1.1 itojun case RTM_IFINFO:
851 1.1 itojun break;
852 1.1 itojun default:
853 1.1 itojun return;
854 1.1 itojun }
855 1.1 itojun /* XXX more filters here? */
856 1.1 itojun
857 1.1 itojun syslog(LOG_INFO, "update interface address list");
858 1.1 itojun free_myaddrs();
859 1.1 itojun grab_myaddrs();
860 1.1 itojun }
861 1.1 itojun #endif /*USE_ROUTE*/
862 1.1 itojun
863 1.1 itojun static void
864 1.1 itojun usage()
865 1.1 itojun {
866 1.17 itojun fprintf(stderr, "usage: %s [-dp] [-f conf] service [serverpath [serverargs]]\n",
867 1.1 itojun faithdname);
868 1.1 itojun exit(0);
869 1.1 itojun }
870