ViewVC Help
View File | Revision Log | Show Annotations | Download File
/cvs/gvpe/src/vpn.C
Revision: 1.50
Committed: Sun Aug 10 02:49:21 2008 UTC (15 years, 9 months ago) by pcg
Content type: text/plain
Branch: MAIN
Changes since 1.49: +12 -13 lines
Log Message:
lots bugfixing

File Contents

# Content
1 /*
2 vpn.C -- handle the protocol, encryption, handshaking etc.
3 Copyright (C) 2003-2008 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 ()
126 {
127 ipv4_tos = -1;
128 ipv4_fd = -1;
129
130 if (THISNODE->protocols & PROT_IPv4 && ::conf.ip_proto)
131 {
132 ipv4_fd = socket (PF_INET, SOCK_RAW, ::conf.ip_proto);
133
134 if (ipv4_fd < 0)
135 return -1;
136
137 fcntl (ipv4_fd, F_SETFL, O_NONBLOCK);
138 fcntl (ipv4_fd, F_SETFD, FD_CLOEXEC);
139
140 #if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
141 // this I really consider a linux bug. I am neither connected
142 // nor do I fragment myself. Linux still sets DF and doesn't
143 // fragment for me sometimes.
144 {
145 int oval = IP_PMTUDISC_DONT;
146 setsockopt (ipv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
147 }
148 #endif
149
150 sockinfo si (THISNODE, PROT_IPv4);
151
152 if (bind (ipv4_fd, si.sav4 (), si.salenv4 ()))
153 {
154 slog (L_ERR, _("can't bind ipv4 socket on %s: %s, exiting."), (const char *)si, strerror (errno));
155 exit (EXIT_FAILURE);
156 }
157
158 ipv4_ev_watcher.start (ipv4_fd, EV_READ);
159 }
160
161 udpv4_tos = -1;
162 udpv4_fd = -1;
163
164 if (THISNODE->protocols & PROT_UDPv4 && THISNODE->udp_port)
165 {
166 udpv4_fd = socket (PF_INET, SOCK_DGRAM, IPPROTO_UDP);
167
168 if (udpv4_fd < 0)
169 return -1;
170
171 fcntl (udpv4_fd, F_SETFL, O_NONBLOCK);
172 fcntl (udpv4_fd, F_SETFD, FD_CLOEXEC);
173
174 // standard daemon practise...
175 {
176 int oval = 1;
177 setsockopt (udpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
178 }
179
180 #if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
181 // this I really consider a linux bug. I am neither connected
182 // nor do I fragment myself. Linux still sets DF and doesn't
183 // fragment for me sometimes.
184 {
185 int oval = IP_PMTUDISC_DONT;
186 setsockopt (udpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
187 }
188 #endif
189
190 sockinfo si (THISNODE, PROT_UDPv4);
191
192 if (bind (udpv4_fd, si.sav4 (), si.salenv4 ()))
193 {
194 slog (L_ERR, _("can't bind udpv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
195 exit (EXIT_FAILURE);
196 }
197
198 udpv4_ev_watcher.start (udpv4_fd, EV_READ);
199 }
200
201 icmpv4_tos = -1;
202 icmpv4_fd = -1;
203
204 #if ENABLE_ICMP
205 if (THISNODE->protocols & PROT_ICMPv4)
206 {
207 icmpv4_fd = socket (PF_INET, SOCK_RAW, IPPROTO_ICMP);
208
209 if (icmpv4_fd < 0)
210 return -1;
211
212 fcntl (icmpv4_fd, F_SETFL, O_NONBLOCK);
213 fcntl (icmpv4_fd, F_SETFD, FD_CLOEXEC);
214
215 #ifdef ICMP_FILTER
216 {
217 icmp_filter oval;
218 oval.data = 0xffffffff;
219 if (::conf.icmp_type < 32)
220 oval.data &= ~(1 << ::conf.icmp_type);
221
222 setsockopt (icmpv4_fd, SOL_RAW, ICMP_FILTER, &oval, sizeof oval);
223 }
224 #endif
225
226 #if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
227 // this I really consider a linux bug. I am neither connected
228 // nor do I fragment myself. Linux still sets DF and doesn't
229 // fragment for me sometimes.
230 {
231 int oval = IP_PMTUDISC_DONT;
232 setsockopt (icmpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
233 }
234 #endif
235
236 sockinfo si (THISNODE, PROT_ICMPv4);
237
238 if (bind (icmpv4_fd, si.sav4 (), si.salenv4 ()))
239 {
240 slog (L_ERR, _("can't bind icmpv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
241 exit (EXIT_FAILURE);
242 }
243
244 icmpv4_ev_watcher.start (icmpv4_fd, EV_READ);
245 }
246 #endif
247
248 tcpv4_fd = -1;
249
250 #if ENABLE_TCP
251 if (THISNODE->protocols & PROT_TCPv4 && THISNODE->tcp_port)
252 {
253 tcpv4_fd = socket (PF_INET, SOCK_STREAM, IPPROTO_TCP);
254
255 if (tcpv4_fd < 0)
256 return -1;
257
258 fcntl (tcpv4_fd, F_SETFL, O_NONBLOCK);
259 fcntl (tcpv4_fd, F_SETFD, FD_CLOEXEC);
260
261 // standard daemon practise...
262 {
263 int oval = 1;
264 setsockopt (tcpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
265 }
266
267 sockinfo si (THISNODE, PROT_TCPv4);
268
269 if (bind (tcpv4_fd, si.sav4 (), si.salenv4 ()))
270 {
271 slog (L_ERR, _("can't bind tcpv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
272 exit (EXIT_FAILURE);
273 }
274
275 if (listen (tcpv4_fd, 5))
276 {
277 slog (L_ERR, _("can't listen tcpv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
278 exit (EXIT_FAILURE);
279 }
280
281 tcpv4_ev_watcher.start (tcpv4_fd, EV_READ);
282 }
283 #endif
284
285 dnsv4_tos = -1;
286 dnsv4_fd = -1;
287
288 #if ENABLE_DNS
289 if (THISNODE->protocols & PROT_DNSv4)
290 {
291 dns_forwarder.set (::conf.dns_forw_host, ::conf.dns_forw_port, PROT_DNSv4);
292
293 dnsv4_fd = socket (PF_INET, SOCK_DGRAM, IPPROTO_UDP);
294
295 if (dnsv4_fd < 0)
296 return -1;
297
298 fcntl (dnsv4_fd, F_SETFL, O_NONBLOCK);
299 fcntl (dnsv4_fd, F_SETFD, FD_CLOEXEC);
300
301 # if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
302 // this I really consider a linux bug. I am neither connected
303 // nor do I fragment myself. Linux still sets DF and doesn't
304 // fragment for me sometimes.
305 {
306 int oval = IP_PMTUDISC_DONT;
307 setsockopt (dnsv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
308 }
309 # endif
310
311 // standard daemon practise...
312 {
313 int oval = 1;
314 setsockopt (dnsv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
315 }
316
317 sockinfo si (THISNODE->dns_hostname,
318 THISNODE->dns_hostname ? THISNODE->dns_port : 0,
319 PROT_DNSv4);
320
321 if (bind (dnsv4_fd, si.sav4 (), si.salenv4 ()))
322 {
323 slog (L_ERR, _("can't bind dnsv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
324 exit (EXIT_FAILURE);
325 }
326
327 dnsv4_ev_watcher.start (dnsv4_fd, EV_READ);
328 }
329 #endif
330
331 /////////////////////////////////////////////////////////////////////////////
332
333 reconnect_all ();
334
335 /////////////////////////////////////////////////////////////////////////////
336
337 tap = new tap_device ();
338 if (!tap) //D this, of course, never catches
339 {
340 slog (L_ERR, _("cannot create network interface '%s', exiting."), conf.ifname);
341 exit (EXIT_FAILURE);
342 }
343
344 fcntl (tap->fd, F_SETFD, FD_CLOEXEC);
345
346 run_script_cb cb;
347 cb.set<vpn, &vpn::script_if_init> (this);
348
349 if (tap->if_up () &&
350 !run_script (cb, true))
351 {
352 slog (L_ERR, _("interface initialization command '%s' failed, exiting."),
353 tap->if_up ());
354 exit (EXIT_FAILURE);
355 }
356
357 cb.set<vpn, &vpn::script_if_up> (this);
358 if (!run_script (cb, true))
359 {
360 slog (L_ERR, _("if-up command execution failed, exiting."));
361 exit (EXIT_FAILURE);
362 }
363
364 tap_ev_watcher.start (tap->fd, EV_READ);
365
366 return 0;
367 }
368
369 bool
370 vpn::send_ipv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
371 {
372 set_tos (ipv4_fd, ipv4_tos, tos);
373 sendto (ipv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
374
375 return true;
376 }
377
378 static u16
379 ipv4_checksum (u16 *data, unsigned int len)
380 {
381 // use 32 bit accumulator and fold back carry bits at the end
382 u32 sum = 0;
383
384 while (len > 1)
385 {
386 sum += *data++;
387 len -= 2;
388 }
389
390 // odd byte left?
391 if (len)
392 sum += *(u8 *)data;
393
394 // add back carry bits
395 sum = (sum >> 16) + (sum & 0xffff); // lo += hi
396 sum += (sum >> 16); // carry
397
398 return ~sum;
399 }
400
401 #if ENABLE_ICMP
402 bool
403 vpn::send_icmpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
404 {
405 pkt->unshift_hdr (4);
406
407 icmp_header *hdr = (icmp_header *)&((*pkt)[0]);
408 hdr->type = ::conf.icmp_type;
409 hdr->code = 255;
410 hdr->checksum = 0;
411 hdr->checksum = ipv4_checksum ((u16 *)hdr, pkt->len);
412
413 set_tos (icmpv4_fd, icmpv4_tos, tos);
414 sendto (icmpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
415
416 return true;
417 }
418 #endif
419
420 bool
421 vpn::send_udpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
422 {
423 set_tos (udpv4_fd, udpv4_tos, tos);
424 sendto (udpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
425
426 return true;
427 }
428
429 void
430 vpn::inject_data_packet (tap_packet *pkt, int dst)
431 {
432 if (dst)
433 {
434 // unicast
435 if (dst != THISNODE->id)
436 conns[dst - 1]->inject_data_packet (pkt);
437 }
438 else
439 {
440 // broadcast, this is ugly, but due to the security policy
441 // we have to connect to all hosts...
442 for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
443 if ((*c)->conf != THISNODE)
444 (*c)->inject_data_packet (pkt);
445 }
446 }
447
448 void
449 vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)
450 {
451 unsigned int src = pkt->src ();
452 unsigned int dst = pkt->dst ();
453
454 slog (L_NOISE, _("<<?/%s received possible vpn packet type %d from %d to %d, length %d."),
455 (const char *)rsi, pkt->typ (), pkt->src (), pkt->dst (), pkt->len);
456
457 if (src == 0 || src > conns.size ()
458 || dst > conns.size ()
459 || pkt->typ () >= vpn_packet::PT_MAX)
460 slog (L_WARN, _("(%s): received corrupted packet type %d (src %d, dst %d)."),
461 (const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
462 else if (dst > conns.size ())
463 slog (L_WARN, _("(%s): received corrupted packet type %d (src %d, dst %d)."),
464 (const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
465 else
466 {
467 connection *c = conns[src - 1];
468
469 if (dst == 0)
470 slog (L_WARN, _("%s(%s): received broadcast (protocol violation)."),
471 c->conf->nodename, (const char *)rsi);
472 else if (dst != THISNODE->id)
473 {
474 if (THISNODE->routerprio)
475 // the tos setting gets lost here. who cares.
476 conns[dst - 1]->inject_vpn_packet (pkt);
477 else
478 slog (L_WARN,
479 _("%s(%s): request to forward packet to %s, but we are no router (config mismatch?)."),
480 c->conf->nodename, (const char *)rsi,
481 conns[dst - 1]->conf->nodename);
482 }
483 else
484 c->recv_vpn_packet (pkt, rsi);
485 }
486 }
487
488 bool
489 vpn::send_vpn_packet (vpn_packet *pkt, const sockinfo &si, int tos)
490 {
491 switch (si.prot)
492 {
493 case PROT_IPv4:
494 return send_ipv4_packet (pkt, si, tos);
495
496 case PROT_UDPv4:
497 return send_udpv4_packet (pkt, si, tos);
498
499 #if ENABLE_TCP
500 case PROT_TCPv4:
501 return send_tcpv4_packet (pkt, si, tos);
502 #endif
503 #if ENABLE_ICMP
504 case PROT_ICMPv4:
505 return send_icmpv4_packet (pkt, si, tos);
506 #endif
507 #if ENABLE_DNS
508 case PROT_DNSv4:
509 return send_dnsv4_packet (pkt, si, tos);
510 #endif
511 default:
512 slog (L_CRIT, _("%s: FATAL: trying to send packet with unsupported protocol."), (const char *)si);
513 }
514
515 return false;
516 }
517
518 inline void
519 vpn::ipv4_ev (ev::io &w, int revents)
520 {
521 if (revents & EV_READ)
522 {
523 vpn_packet *pkt = new vpn_packet;
524 struct sockaddr_in sa;
525 socklen_t sa_len = sizeof (sa);
526 int len;
527
528 len = recvfrom (w.fd, &((*pkt)[0]), MAXSIZE, 0, (sockaddr *)&sa, &sa_len);
529
530 sockinfo si(sa, PROT_IPv4);
531
532 if (len > 0)
533 {
534 pkt->len = len;
535
536 // raw sockets deliver the ipv4 header, but don't expect it on sends
537 pkt->skip_hdr (IP_OVERHEAD);
538
539 recv_vpn_packet (pkt, si);
540 }
541 else
542 {
543 // probably ECONNRESET or somesuch
544 slog (L_DEBUG, _("%s: %s."), (const char *)si, strerror (errno));
545 }
546
547 delete pkt;
548 }
549 else
550 {
551 slog (L_ERR,
552 _("FATAL: unknown revents %08x in socket, exiting.\n"),
553 revents);
554 exit (EXIT_FAILURE);
555 }
556 }
557
558 #if ENABLE_ICMP
559 inline void
560 vpn::icmpv4_ev (ev::io &w, int revents)
561 {
562 if (revents & EV_READ)
563 {
564 vpn_packet *pkt = new vpn_packet;
565 struct sockaddr_in sa;
566 socklen_t sa_len = sizeof (sa);
567 int len;
568
569 len = recvfrom (w.fd, &((*pkt)[0]), MAXSIZE, 0, (sockaddr *)&sa, &sa_len);
570
571 sockinfo si(sa, PROT_ICMPv4);
572
573 if (len > 0)
574 {
575 pkt->len = len;
576
577 icmp_header *hdr = (icmp_header *)&((*pkt)[IP_OVERHEAD]);
578
579 if (hdr->type == ::conf.icmp_type
580 && hdr->code == 255)
581 {
582 // raw sockets deliver the ipv4, but don't expect it on sends
583 // this is slow, but...
584 pkt->skip_hdr (ICMP_OVERHEAD);
585
586 recv_vpn_packet (pkt, si);
587 }
588 }
589 else
590 {
591 // probably ECONNRESET or somesuch
592 slog (L_DEBUG, _("%s: %s."), (const char *)si, strerror (errno));
593 }
594
595 delete pkt;
596 }
597 else
598 {
599 slog (L_ERR,
600 _("FATAL: unknown revents %08x in socket, exiting.\n"),
601 revents);
602 exit (EXIT_FAILURE);
603 }
604 }
605 #endif
606
607 inline void
608 vpn::udpv4_ev (ev::io &w, int revents)
609 {
610 if (revents & EV_READ)
611 {
612 vpn_packet *pkt = new vpn_packet;
613 struct sockaddr_in sa;
614 socklen_t sa_len = sizeof (sa);
615 int len;
616
617 len = recvfrom (w.fd, &((*pkt)[0]), MAXSIZE, 0, (sockaddr *)&sa, &sa_len);
618
619 sockinfo si(sa, PROT_UDPv4);
620
621 if (len > 0)
622 {
623 pkt->len = len;
624
625 recv_vpn_packet (pkt, si);
626 }
627 else
628 {
629 // probably ECONNRESET or somesuch
630 slog (L_DEBUG, _("%s: fd %d, %s."), (const char *)si, w.fd, strerror (errno));
631 }
632
633 delete pkt;
634 }
635 else
636 {
637 slog (L_ERR,
638 _("FATAL: unknown revents %08x in socket, exiting.\n"),
639 revents);
640 exit (EXIT_FAILURE);
641 }
642 }
643
644 inline void
645 vpn::tap_ev (ev::io &w, int revents)
646 {
647 if (revents & EV_READ)
648 {
649 /* process data */
650 tap_packet *pkt;
651
652 pkt = tap->recv ();
653
654 if (!pkt)
655 return;
656
657 if (pkt->len > 14)
658 {
659 int dst = mac2id (pkt->dst);
660 int src = mac2id (pkt->src);
661
662 if (src != THISNODE->id)
663 {
664 slog (L_ERR, _("FATAL: tap packet not originating on current node received (if-up script not working properly?), exiting."));
665 exit (EXIT_FAILURE);
666 }
667
668 if (dst == THISNODE->id)
669 {
670 slog (L_ERR, _("FATAL: tap packet destined for current node received, exiting."));
671 exit (EXIT_FAILURE);
672 }
673
674 if (dst > conns.size ())
675 slog (L_ERR, _("tap packet for unknown node %d received, ignoring."), dst);
676 else
677 inject_data_packet (pkt, dst);
678 }
679
680 delete pkt;
681 }
682 else
683 abort ();
684 }
685
686 inline void
687 vpn::event_cb (ev::timer &w, int)
688 {
689 if (events)
690 {
691 if (events & EVENT_SHUTDOWN)
692 {
693 slog (L_INFO, _("preparing shutdown..."));
694
695 shutdown_all ();
696 remove_pid (conf.pidfilename);
697 slog (L_INFO, _("exiting."));
698 exit (EXIT_SUCCESS);
699 }
700
701 if (events & EVENT_RECONNECT)
702 {
703 slog (L_INFO, _("forced reconnect."));
704
705 reconnect_all ();
706 }
707
708 events = 0;
709 }
710 }
711
712 void
713 vpn::shutdown_all ()
714 {
715 for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
716 (*c)->shutdown ();
717 }
718
719 void
720 vpn::reconnect_all ()
721 {
722 for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
723 delete *c;
724
725 conns.clear ();
726
727 connection_init ();
728
729 for (configuration::node_vector::iterator i = conf.nodes.begin (); i != conf.nodes.end (); ++i)
730 conns.push_back (new connection (this, *i));
731
732 for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
733 (*c)->establish_connection ();
734 }
735
736 bool vpn::can_direct (conf_node *src, conf_node *dst) const
737 {
738 return src != dst
739 && src->may_direct (dst)
740 && dst->may_direct (src)
741 && (((src->protocols & dst->protocols) && src->connectmode == conf_node::C_ALWAYS)
742 || (src->protocols & dst->connectable_protocols ()));
743 }
744
745 // only works for indirect and routed connections: find a router
746 // from THISNODE to dst
747 connection *vpn::find_router_for (const connection *dst)
748 {
749 connection *router = 0;
750
751 // first try to find a router with a direct connection
752 {
753 u32 prio = 1;
754
755 for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
756 {
757 connection *c = *i;
758
759 if (c->conf->routerprio > prio
760 && c->conf != THISNODE
761 && c != dst
762 && can_direct (c->conf, dst->conf))
763 {
764 if (c->ictx && c->octx)
765 {
766 prio = c->conf->routerprio;
767 router = c;
768 }
769 else
770 c->establish_connection ();
771 }
772 }
773 }
774
775 if (router)
776 return router;
777
778 // second try find the router with the highest priority higher than ours
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->routerprio > THISNODE->routerprio
788 && c != dst
789 && c->conf != THISNODE)
790 {
791 if (c->ictx && c->octx)
792 {
793 prio = c->conf->routerprio;
794 router = c;
795 }
796 else
797 c->establish_connection ();
798 }
799 }
800 }
801 return router;
802 }
803
804 void vpn::connection_established (connection *c)
805 {
806 for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
807 {
808 connection *o = *i;
809
810 if (!o->is_direct
811 && o->si.valid ()
812 && c->si != o->si
813 && c == find_router_for (o))
814 {
815 slog (L_DEBUG, _("%s: can now route packets via %s, re-keying connection."),
816 o->conf->nodename, c->conf->nodename);
817 o->rekey ();
818 }
819 }
820 }
821
822 void vpn::send_connect_request (connection *c)
823 {
824 connection *r = find_router_for (c);
825
826 if (r)
827 {
828 slog (L_TRACE, _("%s: no way to connect, sending mediated connection request via %s."),
829 c->conf->nodename, r->conf->nodename);
830 r->send_connect_request (c->conf->id);
831 }
832 else
833 slog (L_DEBUG, _("%s: no way to connect and no router found: unable to connect."),
834 c->conf->nodename);
835 }
836
837 void
838 connection::dump_status ()
839 {
840 slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);
841 slog (L_NOTICE, _(" connectmode %d (%d) / sockaddr %s / minor %d"),
842 connectmode, conf->connectmode, (const char *)si, (int)prot_minor);
843 slog (L_NOTICE, _(" ictx/octx %08lx/%08lx / oseqno %d / retry_cnt %d"),
844 (long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);
845 }
846
847 void
848 vpn::dump_status ()
849 {
850 slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)ev_now ());
851
852 for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
853 (*c)->dump_status ();
854
855 slog (L_NOTICE, _("END status dump"));
856 }
857
858 vpn::vpn (void)
859 {
860 event .set<vpn, &vpn::event_cb > (this);
861 udpv4_ev_watcher .set<vpn, &vpn::udpv4_ev > (this);
862 ipv4_ev_watcher .set<vpn, &vpn::ipv4_ev > (this);
863 #if ENABLE_TCP
864 tcpv4_ev_watcher .set<vpn, &vpn::tcpv4_ev > (this);
865 #endif
866 #if ENABLE_ICMP
867 icmpv4_ev_watcher.set<vpn, &vpn::icmpv4_ev> (this);
868 #endif
869 #if ENABLE_DNS
870 dnsv4_ev_watcher .set<vpn, &vpn::dnsv4_ev > (this);
871 #endif
872 tap_ev_watcher .set<vpn, &vpn::tap_ev > (this);
873 }
874
875 vpn::~vpn ()
876 {
877 }
878