ViewVC Help
View File | Revision Log | Show Annotations | Download File
/cvs/gvpe/src/vpn.C
Revision: 1.61
Committed: Fri Sep 16 18:08:03 2011 UTC (12 years, 8 months ago) by root
Content type: text/plain
Branch: MAIN
Changes since 1.60: +0 -3 lines
Log Message:
ugh

File Contents

# Content
1 /*
2 vpn.C -- handle the protocol, encryption, handshaking etc.
3 Copyright (C) 2003-2008,2010,2011 Marc Lehmann <gvpe@schmorp.de>
4
5 This file is part of GVPE.
6
7 GVPE is free software; you can redistribute it and/or modify it
8 under the terms of the GNU General Public License as published by the
9 Free Software Foundation; either version 3 of the License, or (at your
10 option) any later version.
11
12 This program is distributed in the hope that it will be useful, but
13 WITHOUT ANY WARRANTY; without even the implied warranty of
14 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General
15 Public License for more details.
16
17 You should have received a copy of the GNU General Public License along
18 with this program; if not, see <http://www.gnu.org/licenses/>.
19
20 Additional permission under GNU GPL version 3 section 7
21
22 If you modify this Program, or any covered work, by linking or
23 combining it with the OpenSSL project's OpenSSL library (or a modified
24 version of that library), containing parts covered by the terms of the
25 OpenSSL or SSLeay licenses, the licensors of this Program grant you
26 additional permission to convey the resulting work. Corresponding
27 Source for a non-source form of such a combination shall include the
28 source code for the parts of OpenSSL used as well as that of the
29 covered work.
30 */
31
32 #include "config.h"
33
34 #include <list>
35
36 #include <cstdio>
37 #include <cstring>
38 #include <cstdlib>
39
40 #include <sys/types.h>
41 #include <sys/socket.h>
42 #include <sys/wait.h>
43 #include <errno.h>
44 #include <time.h>
45 #include <unistd.h>
46 #include <fcntl.h>
47 #include <sys/socket.h>
48
49 #include "netcompat.h"
50
51 #include "pidfile.h"
52
53 #include "connection.h"
54 #include "util.h"
55 #include "vpn.h"
56
57 vpn network; // THE vpn (bad design...)
58
59 /////////////////////////////////////////////////////////////////////////////
60
61 static void inline
62 set_tos (int fd, int &tos_prev, int tos)
63 {
64 #if defined(SOL_IP) && defined(IP_TOS)
65 if (tos_prev == tos)
66 return;
67
68 tos_prev = tos;
69 setsockopt (fd, SOL_IP, IP_TOS, &tos, sizeof tos);
70 #endif
71 }
72
73 void
74 vpn::script_init_env ()
75 {
76 // the tunnel device mtu should be the physical mtu - overhead
77 // the tricky part is rounding to the cipher key blocksize
78 int mtu = conf.mtu - ETH_OVERHEAD - VPE_OVERHEAD - MAX_OVERHEAD;
79 mtu += ETH_OVERHEAD - 6 - 6; // now we have the data portion
80 mtu -= mtu % EVP_CIPHER_block_size (CIPHER); // round
81 mtu -= ETH_OVERHEAD - 6 - 6; // and get interface mtu again
82
83 char *env;
84 asprintf (&env, "CONFBASE=%s", confbase); putenv (env);
85 asprintf (&env, "IFNAME=%s", tap->interface ()); putenv (env);
86 asprintf (&env, "IFTYPE=%s", IFTYPE); putenv (env);
87 asprintf (&env, "IFSUBTYPE=%s", IFSUBTYPE); putenv (env);
88 asprintf (&env, "MTU=%d", mtu); putenv (env);
89 asprintf (&env, "NODES=%d", conns.size ()); putenv (env);
90 asprintf (&env, "NODEID=%d", THISNODE->id); putenv (env);
91
92 conns [THISNODE->id - 1]->script_init_env ("");
93
94 for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
95 {
96 char ext[16];
97 snprintf (ext, 16, "_%d", (*c)->conf->id);
98 (*c)->script_init_env (ext);
99 }
100 }
101
102 inline const char *
103 vpn::script_if_init ()
104 {
105 script_init_env ();
106
107 return tap->if_up ();
108 }
109
110 inline const char *
111 vpn::script_if_up ()
112 {
113 script_init_env ();
114
115 char *filename;
116 asprintf (&filename,
117 "%s/%s",
118 confbase,
119 ::conf.script_if_up ? ::conf.script_if_up : "if-up");
120
121 return filename;
122 }
123
124 int
125 vpn::setup_socket (u8 prot, int family, int type, int proto)
126 {
127 int fd = socket (family, type, proto);
128
129 if (fd < 0)
130 {
131 slog (L_ERR, _("unable to create %s socket: %s."), strprotocol (prot), strerror (errno));
132 return fd;
133 }
134
135 fcntl (fd, F_SETFL, O_NONBLOCK);
136 fcntl (fd, F_SETFD, FD_CLOEXEC);
137
138 #ifdef SO_MARK
139 if (::conf.nfmark)
140 if (setsockopt (fd, SOL_SOCKET, SO_MARK, &::conf.nfmark, sizeof ::conf.nfmark))
141 slog (L_WARN, _("unable to set nfmark on %s socket: %s"), strprotocol (prot), strerror (errno));
142 #endif
143
144 return fd;
145 }
146
147 int
148 vpn::setup ()
149 {
150 int success = 0;
151
152 ipv4_tos = -1;
153 ipv4_fd = -1;
154
155 if (THISNODE->protocols & PROT_IPv4 && ::conf.ip_proto)
156 {
157 ipv4_fd = setup_socket (PROT_IPv4, PF_INET, SOCK_RAW, ::conf.ip_proto);
158
159 if (ipv4_fd < 0)
160 return -1;
161
162 #if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
163 // this I really consider a linux bug. I am neither connected
164 // nor do I fragment myself. Linux still sets DF and doesn't
165 // fragment for me sometimes.
166 {
167 int oval = IP_PMTUDISC_DONT;
168 setsockopt (ipv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
169 }
170 #endif
171
172 sockinfo si (THISNODE, PROT_IPv4);
173
174 if (bind (ipv4_fd, si.sav4 (), si.salenv4 ()))
175 {
176 slog (L_ERR, _("can't bind ipv4 socket on %s: %s, exiting."), (const char *)si, strerror (errno));
177 return -1;
178 }
179
180 ipv4_ev_watcher.start (ipv4_fd, EV_READ);
181 ++success;
182 }
183 else
184 THISNODE->protocols &= ~PROT_IPv4;
185
186 udpv4_tos = -1;
187 udpv4_fd = -1;
188
189 if (THISNODE->protocols & PROT_UDPv4 && THISNODE->udp_port)
190 {
191 udpv4_fd = setup_socket (PROT_UDPv4, PF_INET, SOCK_DGRAM, IPPROTO_UDP);
192
193 if (udpv4_fd < 0)
194 return -1;
195
196 // standard daemon practise...
197 {
198 int oval = 1;
199 setsockopt (udpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
200 }
201
202 #if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
203 // this I really consider a linux bug. I am neither connected
204 // nor do I fragment myself. Linux still sets DF and doesn't
205 // fragment for me sometimes.
206 {
207 int oval = IP_PMTUDISC_DONT;
208 setsockopt (udpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
209 }
210 #endif
211
212 sockinfo si (THISNODE, PROT_UDPv4);
213
214 if (bind (udpv4_fd, si.sav4 (), si.salenv4 ()))
215 {
216 slog (L_ERR, _("can't bind udpv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
217 return -1;
218 }
219
220 udpv4_ev_watcher.start (udpv4_fd, EV_READ);
221 ++success;
222 }
223 else
224 THISNODE->protocols &= ~PROT_UDPv4;
225
226 icmpv4_tos = -1;
227 icmpv4_fd = -1;
228
229 #if ENABLE_ICMP
230 if (THISNODE->protocols & PROT_ICMPv4)
231 {
232 icmpv4_fd = setup_socket (PROT_ICMPv4, PF_INET, SOCK_RAW, IPPROTO_ICMP);
233
234 if (icmpv4_fd < 0)
235 return -1;
236
237 #ifdef ICMP_FILTER
238 {
239 icmp_filter oval;
240 oval.data = 0xffffffff;
241 if (::conf.icmp_type < 32)
242 oval.data &= ~(1 << ::conf.icmp_type);
243
244 setsockopt (icmpv4_fd, SOL_RAW, ICMP_FILTER, &oval, sizeof oval);
245 }
246 #endif
247
248 #if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
249 // this I really consider a linux bug. I am neither connected
250 // nor do I fragment myself. Linux still sets DF and doesn't
251 // fragment for me sometimes.
252 {
253 int oval = IP_PMTUDISC_DONT;
254 setsockopt (icmpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
255 }
256 #endif
257
258 sockinfo si (THISNODE, PROT_ICMPv4);
259
260 if (bind (icmpv4_fd, si.sav4 (), si.salenv4 ()))
261 {
262 slog (L_ERR, _("can't bind icmpv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
263 return -1;
264 }
265
266 icmpv4_ev_watcher.start (icmpv4_fd, EV_READ);
267 ++success;
268 }
269 #endif
270
271 tcpv4_fd = -1;
272
273 #if ENABLE_TCP
274 if (THISNODE->protocols & PROT_TCPv4 && THISNODE->tcp_port)
275 {
276 tcpv4_fd = setup_socket (PROT_TCPv4, PF_INET, SOCK_STREAM, IPPROTO_TCP);
277
278 if (tcpv4_fd < 0)
279 return -1;
280
281 // standard daemon practise...
282 {
283 int oval = 1;
284 setsockopt (tcpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
285 }
286
287 sockinfo si (THISNODE, PROT_TCPv4);
288
289 if (bind (tcpv4_fd, si.sav4 (), si.salenv4 ()))
290 {
291 slog (L_ERR, _("can't bind tcpv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
292 return -1;
293 }
294
295 if (listen (tcpv4_fd, 5))
296 {
297 slog (L_ERR, _("can't listen tcpv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
298 return -1;
299 }
300
301 tcpv4_ev_watcher.start (tcpv4_fd, EV_READ);
302 ++success;
303 }
304 else
305 THISNODE->protocols &= ~PROT_TCPv4;
306 #endif
307
308 dnsv4_tos = -1;
309 dnsv4_fd = -1;
310
311 #if ENABLE_DNS
312 if (THISNODE->protocols & PROT_DNSv4)
313 {
314 dns_forwarder.set (::conf.dns_forw_host, ::conf.dns_forw_port, PROT_DNSv4);
315
316 dnsv4_fd = setup_socket (PROT_DNSv4, PF_INET, SOCK_DGRAM, IPPROTO_UDP);
317
318 if (dnsv4_fd < 0)
319 return -1;
320
321 # if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
322 // this I really consider a linux bug. I am neither connected
323 // nor do I fragment myself. Linux still sets DF and doesn't
324 // fragment for me sometimes.
325 {
326 int oval = IP_PMTUDISC_DONT;
327 setsockopt (dnsv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
328 }
329 # endif
330
331 // standard daemon practise...
332 {
333 int oval = 1;
334 setsockopt (dnsv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
335 }
336
337 sockinfo si (THISNODE->dns_hostname,
338 THISNODE->dns_hostname ? THISNODE->dns_port : 0,
339 PROT_DNSv4);
340
341 if (bind (dnsv4_fd, si.sav4 (), si.salenv4 ()))
342 {
343 slog (L_ERR, _("can't bind dnsv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
344 return -1;
345 }
346
347 dnsv4_ev_watcher.start (dnsv4_fd, EV_READ);
348 ++success;
349 }
350 #endif
351
352 /////////////////////////////////////////////////////////////////////////////
353
354 if (!success)
355 {
356 slog (L_ERR, _("no protocols enabled."));
357 return -1;
358 }
359
360 reconnect_all ();
361
362 /////////////////////////////////////////////////////////////////////////////
363
364 tap = new tap_device ();
365 if (!tap) //D this, of course, never catches
366 {
367 slog (L_ERR, _("cannot create network interface '%s'."), conf.ifname);
368 return -1;
369 }
370
371 fcntl (tap->fd, F_SETFD, FD_CLOEXEC);
372
373 run_script_cb cb;
374 cb.set<vpn, &vpn::script_if_init> (this);
375
376 if (tap->if_up () &&
377 !run_script (cb, true))
378 {
379 slog (L_ERR, _("interface initialization command '%s' failed."),
380 tap->if_up ());
381 return -1;
382 }
383
384 cb.set<vpn, &vpn::script_if_up> (this);
385 if (!run_script (cb, true))
386 {
387 slog (L_ERR, _("if-up command execution failed."));
388 return -1;
389 }
390
391 tap_ev_watcher.start (tap->fd, EV_READ);
392
393 return 0;
394 }
395
396 bool
397 vpn::send_ipv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
398 {
399 set_tos (ipv4_fd, ipv4_tos, tos);
400 sendto (ipv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
401
402 return true;
403 }
404
405 static u16
406 ipv4_checksum (u16 *data, unsigned int len)
407 {
408 // use 32 bit accumulator and fold back carry bits at the end
409 u32 sum = 0;
410
411 while (len > 1)
412 {
413 sum += *data++;
414 len -= 2;
415 }
416
417 // odd byte left?
418 if (len)
419 sum += *(u8 *)data;
420
421 // add back carry bits
422 sum = (sum >> 16) + (sum & 0xffff); // lo += hi
423 sum += (sum >> 16); // carry
424
425 return ~sum;
426 }
427
428 #if ENABLE_ICMP
429 bool
430 vpn::send_icmpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
431 {
432 pkt->unshift_hdr (4);
433
434 icmp_header *hdr = (icmp_header *)&((*pkt)[0]);
435 hdr->type = ::conf.icmp_type;
436 hdr->code = 255;
437 hdr->checksum = 0;
438 hdr->checksum = ipv4_checksum ((u16 *)hdr, pkt->len);
439
440 set_tos (icmpv4_fd, icmpv4_tos, tos);
441 sendto (icmpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
442
443 return true;
444 }
445 #endif
446
447 bool
448 vpn::send_udpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
449 {
450 set_tos (udpv4_fd, udpv4_tos, tos);
451 sendto (udpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
452
453 return true;
454 }
455
456 void
457 vpn::inject_data_packet (tap_packet *pkt, int dst)
458 {
459 if (dst)
460 {
461 // unicast
462 if (dst != THISNODE->id)
463 conns[dst - 1]->inject_data_packet (pkt);
464 }
465 else
466 {
467 // broadcast, this is ugly, but due to the security policy
468 // we have to connect to all hosts...
469 for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
470 if ((*c)->conf != THISNODE)
471 (*c)->inject_data_packet (pkt);
472 }
473 }
474
475 void
476 vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)
477 {
478 unsigned int src = pkt->src ();
479 unsigned int dst = pkt->dst ();
480
481 slog (L_NOISE, _("<<?/%s received possible vpn packet type %d from %d to %d, length %d."),
482 (const char *)rsi, pkt->typ (), pkt->src (), pkt->dst (), pkt->len);
483
484 if (src == 0 || src > conns.size ()
485 || dst > conns.size ()
486 || pkt->typ () >= vpn_packet::PT_MAX)
487 slog (L_WARN, _("(%s): received corrupted packet type %d (src %d, dst %d)."),
488 (const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
489 else
490 {
491 connection *c = conns[src - 1];
492
493 if (dst == 0)
494 slog (L_WARN, _("%s(%s): received broadcast (protocol violation)."),
495 c->conf->nodename, (const char *)rsi);
496 else if (dst != THISNODE->id)
497 {
498 if (THISNODE->routerprio)
499 // the tos setting gets lost here. who cares.
500 conns[dst - 1]->inject_vpn_packet (pkt);
501 else
502 slog (L_WARN,
503 _("%s(%s): request to forward packet to %s, but we are no router (config mismatch?)."),
504 c->conf->nodename, (const char *)rsi,
505 conns[dst - 1]->conf->nodename);
506 }
507 else
508 c->recv_vpn_packet (pkt, rsi);
509 }
510 }
511
512 bool
513 vpn::send_vpn_packet (vpn_packet *pkt, const sockinfo &si, int tos)
514 {
515 switch (si.prot)
516 {
517 case PROT_IPv4:
518 return send_ipv4_packet (pkt, si, tos);
519
520 case PROT_UDPv4:
521 return send_udpv4_packet (pkt, si, tos);
522
523 #if ENABLE_TCP
524 case PROT_TCPv4:
525 return send_tcpv4_packet (pkt, si, tos);
526 #endif
527 #if ENABLE_ICMP
528 case PROT_ICMPv4:
529 return send_icmpv4_packet (pkt, si, tos);
530 #endif
531 #if ENABLE_DNS
532 case PROT_DNSv4:
533 return send_dnsv4_packet (pkt, si, tos);
534 #endif
535 default:
536 slog (L_CRIT, _("%s: FATAL: trying to send packet with unsupported protocol."), (const char *)si);
537 }
538
539 return false;
540 }
541
542 inline void
543 vpn::ipv4_ev (ev::io &w, int revents)
544 {
545 if (revents & EV_READ)
546 {
547 vpn_packet *pkt = new vpn_packet;
548 struct sockaddr_in sa;
549 socklen_t sa_len = sizeof (sa);
550 int len;
551
552 len = recvfrom (w.fd, &((*pkt)[0]), MAXSIZE, 0, (sockaddr *)&sa, &sa_len);
553
554 sockinfo si(sa, PROT_IPv4);
555
556 if (len > 0)
557 {
558 pkt->len = len;
559
560 // raw sockets deliver the ipv4 header, but don't expect it on sends
561 pkt->skip_hdr (pkt->ipv4_hdr_len ());
562
563 recv_vpn_packet (pkt, si);
564 }
565 else
566 {
567 // probably ECONNRESET or somesuch
568 slog (L_DEBUG, _("%s: %s."), (const char *)si, strerror (errno));
569 }
570
571 delete pkt;
572 }
573 else
574 {
575 slog (L_ERR,
576 _("FATAL: unknown revents %08x in socket, exiting.\n"),
577 revents);
578 exit (EXIT_FAILURE);
579 }
580 }
581
582 #if ENABLE_ICMP
583 inline void
584 vpn::icmpv4_ev (ev::io &w, int revents)
585 {
586 if (revents & EV_READ)
587 {
588 vpn_packet *pkt = new vpn_packet;
589 struct sockaddr_in sa;
590 socklen_t sa_len = sizeof (sa);
591 int len;
592
593 len = recvfrom (w.fd, &((*pkt)[0]), MAXSIZE, 0, (sockaddr *)&sa, &sa_len);
594
595 sockinfo si(sa, PROT_ICMPv4);
596
597 if (len > 0)
598 {
599 pkt->len = len;
600
601 icmp_header *hdr = (icmp_header *)&((*pkt)[IP_OVERHEAD]);
602
603 if (hdr->type == ::conf.icmp_type
604 && hdr->code == 255)
605 {
606 // raw sockets deliver the ipv4, but don't expect it on sends
607 // this is slow, but...
608 pkt->skip_hdr (pkt->ipv4_hdr_len () + (ICMP_OVERHEAD - IP_OVERHEAD));
609
610 recv_vpn_packet (pkt, si);
611 }
612 }
613 else
614 {
615 // probably ECONNRESET or somesuch
616 slog (L_DEBUG, _("%s: %s."), (const char *)si, strerror (errno));
617 }
618
619 delete pkt;
620 }
621 else
622 {
623 slog (L_ERR,
624 _("FATAL: unknown revents %08x in socket, exiting.\n"),
625 revents);
626 exit (EXIT_FAILURE);
627 }
628 }
629 #endif
630
631 inline void
632 vpn::udpv4_ev (ev::io &w, int revents)
633 {
634 if (revents & EV_READ)
635 {
636 vpn_packet *pkt = new vpn_packet;
637 struct sockaddr_in sa;
638 socklen_t sa_len = sizeof (sa);
639 int len;
640
641 len = recvfrom (w.fd, &((*pkt)[0]), MAXSIZE, 0, (sockaddr *)&sa, &sa_len);
642
643 sockinfo si(sa, PROT_UDPv4);
644
645 if (len > 0)
646 {
647 pkt->len = len;
648
649 recv_vpn_packet (pkt, si);
650 }
651 else
652 {
653 // probably ECONNRESET or somesuch
654 slog (L_DEBUG, _("%s: fd %d, %s."), (const char *)si, w.fd, strerror (errno));
655 }
656
657 delete pkt;
658 }
659 else
660 {
661 slog (L_ERR,
662 _("FATAL: unknown revents %08x in socket, exiting.\n"),
663 revents);
664 exit (EXIT_FAILURE);
665 }
666 }
667
668 inline void
669 vpn::tap_ev (ev::io &w, int revents)
670 {
671 if (revents & EV_READ)
672 {
673 /* process data */
674 tap_packet *pkt;
675
676 pkt = tap->recv ();
677
678 if (!pkt)
679 return;
680
681 if (pkt->len > 14)
682 {
683 int dst = mac2id (pkt->dst);
684 int src = mac2id (pkt->src);
685
686 if (src != THISNODE->id)
687 {
688 slog (L_ERR, _("FATAL: tap packet not originating on current node received (if-up script not working properly?), exiting."));
689 exit (EXIT_FAILURE);
690 }
691
692 if (dst == THISNODE->id)
693 {
694 slog (L_ERR, _("FATAL: tap packet destined for current node received, exiting."));
695 exit (EXIT_FAILURE);
696 }
697
698 if (dst > conns.size ())
699 slog (L_ERR, _("tap packet for unknown node %d received, ignoring."), dst);
700 else
701 inject_data_packet (pkt, dst);
702 }
703
704 delete pkt;
705 }
706 else
707 abort ();
708 }
709
710 inline void
711 vpn::event_cb (ev::timer &w, int)
712 {
713 if (events)
714 {
715 if (events & EVENT_SHUTDOWN)
716 {
717 slog (L_INFO, _("preparing shutdown..."));
718
719 shutdown_all ();
720 remove_pid (conf.pidfilename);
721 slog (L_INFO, _("exiting."));
722 exit (EXIT_SUCCESS);
723 }
724
725 if (events & EVENT_RECONNECT)
726 {
727 slog (L_INFO, _("forced reconnect."));
728
729 reconnect_all ();
730 }
731
732 events = 0;
733 }
734 }
735
736 void
737 vpn::shutdown_all ()
738 {
739 for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
740 (*c)->shutdown ();
741 }
742
743 void
744 vpn::reconnect_all ()
745 {
746 for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
747 delete *c;
748
749 conns.clear ();
750
751 connection_init ();
752
753 for (configuration::node_vector::iterator i = conf.nodes.begin (); i != conf.nodes.end (); ++i)
754 conns.push_back (new connection (this, *i));
755
756 for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
757 (*c)->establish_connection ();
758 }
759
760 bool
761 vpn::can_direct (conf_node *src, conf_node *dst) const
762 {
763 return src != dst
764 && src->may_direct (dst)
765 && dst->may_direct (src)
766 && (((src->protocols & dst->protocols) && src->connectmode == conf_node::C_ALWAYS)
767 || (src->protocols & dst->connectable_protocols ()));
768 }
769
770 // only works for indirect and routed connections: find a router
771 // from THISNODE to dst
772 connection *
773 vpn::find_router_for (const connection *dst)
774 {
775 connection *router = 0;
776
777 // first try to find a router with a direct connection, route there
778 // regardless of any other considerations.
779 {
780 u32 prio = 1;
781
782 for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
783 {
784 connection *c = *i;
785
786 if (c->conf->routerprio > prio
787 && c->conf != THISNODE
788 && can_direct (c->conf, dst->conf)
789 && c->ictx && c->octx)
790 {
791 prio = c->conf->routerprio;
792 router = c;
793 }
794 }
795 }
796
797 if (router)
798 return router;
799
800 // second try find the router with the highest priority, higher than ours
801 {
802 u32 prio = THISNODE->routerprio ? THISNODE->routerprio : 1;
803
804 for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
805 {
806 connection *c = *i;
807
808 if (c->conf->routerprio > prio
809 && c != dst
810 && c->conf != THISNODE
811 && c->ictx && c->octx)
812 {
813 prio = c->conf->routerprio;
814 router = c;
815 }
816 }
817 }
818
819 return router;
820 }
821
822 void
823 vpn::connection_established (connection *c)
824 {
825 for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
826 {
827 connection *o = *i;
828
829 if (!o->is_direct
830 && o->si.valid ()
831 && c->si != o->si
832 && c == find_router_for (o))
833 {
834 slog (L_DEBUG, _("%s: can now route packets via %s, re-keying connection."),
835 o->conf->nodename, c->conf->nodename);
836 o->rekey ();
837 }
838 }
839 }
840
841 void
842 vpn::send_connect_request (connection *c)
843 {
844 connection *r = find_router_for (c);
845
846 if (r)
847 {
848 slog (L_TRACE, _("%s: no address known, sending mediated connection request via %s."),
849 c->conf->nodename, r->conf->nodename);
850 r->send_connect_request (c->conf->id);
851 }
852 else
853 slog (L_DEBUG, _("%s: no way to connect and no router found: unable to connect at this time."),
854 c->conf->nodename);
855 }
856
857 void
858 connection::dump_status ()
859 {
860 slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);
861 slog (L_NOTICE, _(" connectmode %d (%d) / sockaddr %s / minor %d"),
862 connectmode, conf->connectmode, (const char *)si, (int)prot_minor);
863 slog (L_NOTICE, _(" ictx/octx %08lx/%08lx / oseqno %d / retry_cnt %d"),
864 (long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);
865 }
866
867 void
868 vpn::dump_status ()
869 {
870 slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)ev_now ());
871
872 for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
873 (*c)->dump_status ();
874
875 slog (L_NOTICE, _("END status dump"));
876 }
877
878 vpn::vpn (void)
879 {
880 event .set<vpn, &vpn::event_cb > (this);
881 udpv4_ev_watcher .set<vpn, &vpn::udpv4_ev > (this);
882 ipv4_ev_watcher .set<vpn, &vpn::ipv4_ev > (this);
883 #if ENABLE_TCP
884 tcpv4_ev_watcher .set<vpn, &vpn::tcpv4_ev > (this);
885 #endif
886 #if ENABLE_ICMP
887 icmpv4_ev_watcher.set<vpn, &vpn::icmpv4_ev> (this);
888 #endif
889 #if ENABLE_DNS
890 dnsv4_ev_watcher .set<vpn, &vpn::dnsv4_ev > (this);
891 #endif
892 tap_ev_watcher .set<vpn, &vpn::tap_ev > (this);
893 }
894
895 vpn::~vpn ()
896 {
897 }
898