ViewVC Help
View File | Revision Log | Show Annotations | Download File
/cvs/gvpe/src/vpn.C
Revision: 1.32
Committed: Mon Mar 7 01:31:26 2005 UTC (19 years, 2 months ago) by pcg
Content type: text/plain
Branch: MAIN
CVS Tags: rel-1_8
Changes since 1.31: +10 -0 lines
Log Message:
*** empty log message ***

File Contents

# User Rev Content
1 pcg 1.1 /*
2     vpn.C -- handle the protocol, encryption, handshaking etc.
3 pcg 1.28 Copyright (C) 2003-2005 Marc Lehmann <gvpe@schmorp.de>
4 pcg 1.1
5 pcg 1.28 This file is part of GVPE.
6    
7     GVPE is free software; you can redistribute it and/or modify
8 pcg 1.1 it under the terms of the GNU General Public License as published by
9     the Free Software Foundation; either version 2 of the License, or
10     (at your option) any later version.
11    
12     This program is distributed in the hope that it will be useful,
13     but WITHOUT ANY WARRANTY; without even the implied warranty of
14     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15     GNU General Public License for more details.
16    
17     You should have received a copy of the GNU General Public License
18 pcg 1.28 along with gvpe; if not, write to the Free Software
19 pcg 1.1 Foundation, Inc. 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
20     */
21    
22     #include "config.h"
23    
24     #include <list>
25    
26 pcg 1.23 #include <cstdio>
27     #include <cstring>
28 pcg 1.1 #include <cstdlib>
29    
30     #include <sys/types.h>
31     #include <sys/socket.h>
32     #include <sys/wait.h>
33     #include <errno.h>
34     #include <time.h>
35     #include <unistd.h>
36 pcg 1.11 #include <fcntl.h>
37 pcg 1.14 #include <sys/socket.h>
38 pcg 1.15
39     #include "netcompat.h"
40 pcg 1.1
41     #include "pidfile.h"
42    
43     #include "connection.h"
44     #include "util.h"
45     #include "vpn.h"
46    
47 pcg 1.20 vpn network; // THE vpn (bad design...)
48    
49 pcg 1.1 /////////////////////////////////////////////////////////////////////////////
50    
51 pcg 1.2 const char *vpn::script_if_up ()
52 pcg 1.1 {
53     // the tunnel device mtu should be the physical mtu - overhead
54     // the tricky part is rounding to the cipher key blocksize
55     int mtu = conf.mtu - ETH_OVERHEAD - VPE_OVERHEAD - MAX_OVERHEAD;
56     mtu += ETH_OVERHEAD - 6 - 6; // now we have the data portion
57     mtu -= mtu % EVP_CIPHER_block_size (CIPHER); // round
58     mtu -= ETH_OVERHEAD - 6 - 6; // and get interface mtu again
59    
60     char *env;
61 pcg 1.21 asprintf (&env, "CONFBASE=%s", confbase); putenv (env);
62     asprintf (&env, "NODENAME=%s", THISNODE->nodename); putenv (env);
63     asprintf (&env, "NODEID=%d", THISNODE->id); putenv (env);
64     asprintf (&env, "IFNAME=%s", tap->interface ()); putenv (env);
65     asprintf (&env, "IFTYPE=%s", IFTYPE); putenv (env);
66     asprintf (&env, "IFSUBTYPE=%s", IFSUBTYPE); putenv (env);
67     asprintf (&env, "MTU=%d", mtu); putenv (env);
68 pcg 1.1 asprintf (&env, "MAC=%02x:%02x:%02x:%02x:%02x:%02x",
69     0xfe, 0xfd, 0x80, 0x00, THISNODE->id >> 8,
70     THISNODE->id & 0xff);
71     putenv (env);
72    
73     return ::conf.script_if_up ? ::conf.script_if_up : "if-up";
74     }
75    
76     int
77     vpn::setup ()
78     {
79 pcg 1.8 ipv4_fd = -1;
80 pcg 1.1
81 pcg 1.8 if (THISNODE->protocols & PROT_IPv4 && ::conf.ip_proto)
82 pcg 1.1 {
83 pcg 1.8 ipv4_fd = socket (PF_INET, SOCK_RAW, ::conf.ip_proto);
84 pcg 1.1
85 pcg 1.8 if (ipv4_fd < 0)
86 pcg 1.1 return -1;
87    
88 pcg 1.11 fcntl (ipv4_fd, F_SETFL, O_NONBLOCK);
89    
90 pcg 1.14 #if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
91 pcg 1.1 // this I really consider a linux bug. I am neither connected
92     // nor do I fragment myself. Linux still sets DF and doesn't
93     // fragment for me sometimes.
94     {
95     int oval = IP_PMTUDISC_DONT;
96 pcg 1.8 setsockopt (ipv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
97 pcg 1.1 }
98     #endif
99    
100 pcg 1.9 sockinfo si (THISNODE, PROT_IPv4);
101    
102     if (bind (ipv4_fd, si.sav4 (), si.salenv4 ()))
103     {
104     slog (L_ERR, _("can't bind ipv4 socket on %s: %s"), (const char *)si, strerror (errno));
105 pcg 1.23 exit (EXIT_FAILURE);
106 pcg 1.9 }
107    
108 pcg 1.22 ipv4_ev_watcher.start (ipv4_fd, EVENT_READ);
109 pcg 1.1 }
110    
111 pcg 1.8 udpv4_fd = -1;
112    
113     if (THISNODE->protocols & PROT_UDPv4 && THISNODE->udp_port)
114 pcg 1.1 {
115 pcg 1.8 udpv4_fd = socket (PF_INET, SOCK_DGRAM, IPPROTO_UDP);
116 pcg 1.1
117 pcg 1.8 if (udpv4_fd < 0)
118 pcg 1.1 return -1;
119    
120 pcg 1.11 fcntl (udpv4_fd, F_SETFL, O_NONBLOCK);
121    
122 pcg 1.8 // standard daemon practise...
123     {
124     int oval = 1;
125     setsockopt (udpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
126     }
127    
128 pcg 1.14 #if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
129 pcg 1.9 // this I really consider a linux bug. I am neither connected
130     // nor do I fragment myself. Linux still sets DF and doesn't
131     // fragment for me sometimes.
132     {
133     int oval = IP_PMTUDISC_DONT;
134     setsockopt (udpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
135     }
136     #endif
137    
138 pcg 1.8 sockinfo si (THISNODE, PROT_UDPv4);
139 pcg 1.2
140 pcg 1.8 if (bind (udpv4_fd, si.sav4 (), si.salenv4 ()))
141 pcg 1.1 {
142 pcg 1.8 slog (L_ERR, _("can't bind udpv4 on %s: %s"), (const char *)si, strerror (errno));
143 pcg 1.23 exit (EXIT_FAILURE);
144 pcg 1.1 }
145    
146 pcg 1.22 udpv4_ev_watcher.start (udpv4_fd, EVENT_READ);
147 pcg 1.9 }
148    
149     icmpv4_fd = -1;
150    
151     #if ENABLE_ICMP
152     if (THISNODE->protocols & PROT_ICMPv4)
153     {
154     icmpv4_fd = socket (PF_INET, SOCK_RAW, IPPROTO_ICMP);
155    
156     if (icmpv4_fd < 0)
157     return -1;
158    
159 pcg 1.11 fcntl (icmpv4_fd, F_SETFL, O_NONBLOCK);
160    
161 pcg 1.9 #ifdef ICMP_FILTER
162     {
163     icmp_filter oval;
164     oval.data = 0xffffffff;
165     if (::conf.icmp_type < 32)
166     oval.data &= ~(1 << ::conf.icmp_type);
167    
168     setsockopt (icmpv4_fd, SOL_RAW, ICMP_FILTER, &oval, sizeof oval);
169     }
170     #endif
171    
172 pcg 1.14 #if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
173 pcg 1.1 // this I really consider a linux bug. I am neither connected
174     // nor do I fragment myself. Linux still sets DF and doesn't
175     // fragment for me sometimes.
176     {
177     int oval = IP_PMTUDISC_DONT;
178 pcg 1.8 setsockopt (udpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
179 pcg 1.1 }
180     #endif
181    
182 pcg 1.9 sockinfo si (THISNODE, PROT_ICMPv4);
183    
184     if (bind (icmpv4_fd, si.sav4 (), si.salenv4 ()))
185     {
186     slog (L_ERR, _("can't bind icmpv4 on %s: %s"), (const char *)si, strerror (errno));
187 pcg 1.23 exit (EXIT_FAILURE);
188 pcg 1.9 }
189    
190 pcg 1.22 icmpv4_ev_watcher.start (icmpv4_fd, EVENT_READ);
191 pcg 1.1 }
192 pcg 1.9 #endif
193 pcg 1.1
194 pcg 1.8 tcpv4_fd = -1;
195    
196 pcg 1.2 #if ENABLE_TCP
197 pcg 1.8 if (THISNODE->protocols & PROT_TCPv4 && THISNODE->tcp_port)
198 pcg 1.2 {
199     tcpv4_fd = socket (PF_INET, SOCK_STREAM, IPPROTO_TCP);
200    
201     if (tcpv4_fd < 0)
202     return -1;
203    
204 pcg 1.11 fcntl (tcpv4_fd, F_SETFL, O_NONBLOCK);
205    
206 pcg 1.3 // standard daemon practise...
207     {
208     int oval = 1;
209     setsockopt (tcpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
210     }
211    
212 pcg 1.2 sockinfo si (THISNODE, PROT_TCPv4);
213    
214     if (bind (tcpv4_fd, si.sav4 (), si.salenv4 ()))
215     {
216     slog (L_ERR, _("can't bind tcpv4 on %s: %s"), (const char *)si, strerror (errno));
217 pcg 1.23 exit (EXIT_FAILURE);
218 pcg 1.2 }
219    
220     if (listen (tcpv4_fd, 5))
221     {
222     slog (L_ERR, _("can't listen tcpv4 on %s: %s"), (const char *)si, strerror (errno));
223 pcg 1.23 exit (EXIT_FAILURE);
224 pcg 1.2 }
225    
226 pcg 1.22 tcpv4_ev_watcher.start (tcpv4_fd, EVENT_READ);
227 pcg 1.2 }
228     #endif
229    
230 pcg 1.24 #if ENABLE_DNS
231     if (THISNODE->protocols & PROT_DNSv4)
232     {
233 pcg 1.29 dns_forwarder.set (::conf.dns_forw_host, ::conf.dns_forw_port, PROT_DNSv4);
234    
235 pcg 1.24 dnsv4_fd = socket (PF_INET, SOCK_DGRAM, IPPROTO_UDP);
236    
237     if (dnsv4_fd < 0)
238     return -1;
239    
240 pcg 1.32 #if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
241     // this I really consider a linux bug. I am neither connected
242     // nor do I fragment myself. Linux still sets DF and doesn't
243     // fragment for me sometimes.
244     {
245     int oval = IP_PMTUDISC_DONT;
246     setsockopt (udpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
247     }
248     #endif
249    
250 pcg 1.24 // standard daemon practise...
251     {
252     int oval = 1;
253 pcg 1.31 setsockopt (dnsv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
254 pcg 1.24 }
255    
256 pcg 1.31 sockinfo si (THISNODE->dns_hostname,
257     THISNODE->dns_hostname ? THISNODE->dns_port : 0,
258     PROT_DNSv4);
259 pcg 1.24
260     if (bind (dnsv4_fd, si.sav4 (), si.salenv4 ()))
261     {
262     slog (L_ERR, _("can't bind dnsv4 on %s: %s"), (const char *)si, strerror (errno));
263     exit (EXIT_FAILURE);
264     }
265    
266     dnsv4_ev_watcher.start (dnsv4_fd, EVENT_READ);
267     }
268     #endif
269    
270 pcg 1.1 tap = new tap_device ();
271     if (!tap) //D this, of course, never catches
272     {
273     slog (L_ERR, _("cannot create network interface '%s'"), conf.ifname);
274 pcg 1.23 exit (EXIT_FAILURE);
275 pcg 1.1 }
276    
277     run_script (run_script_cb (this, &vpn::script_if_up), true);
278    
279 pcg 1.22 tap_ev_watcher.start (tap->fd, EVENT_READ);
280 pcg 1.1
281     reconnect_all ();
282    
283     return 0;
284     }
285    
286 pcg 1.7 bool
287 pcg 1.1 vpn::send_ipv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
288     {
289 pcg 1.14 #if defined(SOL_IP) && defined(IP_TOS)
290 pcg 1.1 setsockopt (ipv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
291 pcg 1.14 #endif
292 pcg 1.1 sendto (ipv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
293 pcg 1.7
294     return true;
295 pcg 1.1 }
296    
297 pcg 1.9 static u16
298     ipv4_checksum (u16 *data, unsigned int len)
299     {
300     // use 32 bit accumulator and fold back carry bits at the end
301     u32 sum = 0;
302    
303     while (len > 1)
304     {
305     sum += *data++;
306     len -= 2;
307     }
308    
309     // odd byte left?
310     if (len)
311     sum += *(u8 *)data;
312    
313     // add back carry bits
314     sum = (sum >> 16) + (sum & 0xffff); // lo += hi
315     sum += (sum >> 16); // carry
316    
317     return ~sum;
318     }
319    
320 pcg 1.13 #if ENABLE_ICMP
321 pcg 1.9 bool
322     vpn::send_icmpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
323     {
324 pcg 1.14 #if defined(SOL_IP) && defined(IP_TOS)
325 pcg 1.9 setsockopt (icmpv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
326 pcg 1.14 #endif
327 pcg 1.9
328     pkt->unshift_hdr (4);
329    
330 pcg 1.14 icmp_header *hdr = (icmp_header *)&((*pkt)[0]);
331 pcg 1.9 hdr->type = ::conf.icmp_type;
332     hdr->code = 255;
333     hdr->checksum = 0;
334     hdr->checksum = ipv4_checksum ((u16 *)hdr, pkt->len);
335    
336     sendto (icmpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
337    
338     return true;
339     }
340 pcg 1.13 #endif
341 pcg 1.9
342 pcg 1.7 bool
343 pcg 1.1 vpn::send_udpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
344     {
345 pcg 1.14 #if defined(SOL_IP) && defined(IP_TOS)
346 pcg 1.1 setsockopt (udpv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
347 pcg 1.14 #endif
348 pcg 1.1 sendto (udpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
349 pcg 1.7
350     return true;
351 pcg 1.1 }
352    
353     void
354 pcg 1.18 vpn::inject_data_packet (tap_packet *pkt, int dst)
355     {
356     if (dst)
357     {
358     // unicast
359     if (dst != THISNODE->id)
360     conns[dst - 1]->inject_data_packet (pkt);
361     }
362     else
363     {
364     // broadcast, this is ugly, but due to the security policy
365     // we have to connect to all hosts...
366     for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
367     if ((*c)->conf != THISNODE)
368     (*c)->inject_data_packet (pkt, true);
369     }
370     }
371    
372     void
373 pcg 1.1 vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)
374     {
375     unsigned int src = pkt->src ();
376     unsigned int dst = pkt->dst ();
377    
378     slog (L_NOISE, _("<<?/%s received possible vpn packet type %d from %d to %d, length %d"),
379     (const char *)rsi, pkt->typ (), pkt->src (), pkt->dst (), pkt->len);
380    
381     if (src == 0 || src > conns.size ()
382     || dst > conns.size ()
383     || pkt->typ () >= vpn_packet::PT_MAX)
384     slog (L_WARN, _("(%s): received corrupted packet type %d (src %d, dst %d)"),
385     (const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
386 pcg 1.6 else if (dst > conns.size ())
387     slog (L_WARN, _("(%s): received corrupted packet type %d (src %d, dst %d)"),
388     (const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
389 pcg 1.1 else
390     {
391     connection *c = conns[src - 1];
392    
393 pcg 1.13 if (dst == 0)
394     slog (L_WARN, _("%s(%s): received broadcast (protocol violation)"),
395 pcg 1.1 c->conf->nodename, (const char *)rsi);
396 pcg 1.18 else if (dst != THISNODE->id)
397 pcg 1.6 {
398     if (THISNODE->routerprio)
399     // the tos setting gets lost here. who cares.
400     conns[dst - 1]->inject_vpn_packet (pkt);
401     else
402     slog (L_WARN,
403     _("%s(%s): forwarding request (=> %s), but we are no router"),
404     c->conf->nodename, (const char *)rsi,
405     conns[dst - 1]->conf->nodename);
406     }
407 pcg 1.1 else
408     c->recv_vpn_packet (pkt, rsi);
409     }
410     }
411    
412 pcg 1.31 bool
413     vpn::send_vpn_packet (vpn_packet *pkt, const sockinfo &si, int tos)
414     {
415     switch (si.prot)
416     {
417     case PROT_IPv4:
418     return send_ipv4_packet (pkt, si, tos);
419     case PROT_UDPv4:
420     return send_udpv4_packet (pkt, si, tos);
421     #if ENABLE_TCP
422     case PROT_TCPv4:
423     return send_tcpv4_packet (pkt, si, tos);
424     #endif
425     #if ENABLE_ICMP
426     case PROT_ICMPv4:
427     return send_icmpv4_packet (pkt, si, tos);
428     #endif
429     #if ENABLE_DNS
430     case PROT_DNSv4:
431     return send_dnsv4_packet (pkt, si, tos);
432     #endif
433    
434     default:
435     slog (L_CRIT, _("%s: FATAL: trying to send packet with unsupported protocol"), (const char *)si);
436     }
437    
438     return false;
439     }
440    
441 pcg 1.1 void
442 pcg 1.9 vpn::ipv4_ev (io_watcher &w, short revents)
443 pcg 1.1 {
444 pcg 1.22 if (revents & EVENT_READ)
445 pcg 1.1 {
446     vpn_packet *pkt = new vpn_packet;
447     struct sockaddr_in sa;
448     socklen_t sa_len = sizeof (sa);
449     int len;
450    
451 pcg 1.5 len = recvfrom (w.fd, &((*pkt)[0]), MAXSIZE, 0, (sockaddr *)&sa, &sa_len);
452 pcg 1.1
453 pcg 1.9 sockinfo si(sa, PROT_IPv4);
454 pcg 1.1
455     if (len > 0)
456     {
457     pkt->len = len;
458    
459 pcg 1.30 // raw sockets deliver the ipv4 header, but don't expect it on sends
460 pcg 1.9 pkt->skip_hdr (IP_OVERHEAD);
461    
462 pcg 1.1 recv_vpn_packet (pkt, si);
463     }
464     else
465     {
466     // probably ECONNRESET or somesuch
467 pcg 1.9 slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));
468 pcg 1.1 }
469    
470     delete pkt;
471     }
472     else
473     {
474     slog (L_ERR,
475 pcg 1.30 _("FATAL: unknown revents %08x in socket, terminating\n"),
476     revents);
477 pcg 1.23 exit (EXIT_FAILURE);
478 pcg 1.1 }
479     }
480    
481 pcg 1.13 #if ENABLE_ICMP
482 pcg 1.1 void
483 pcg 1.9 vpn::icmpv4_ev (io_watcher &w, short revents)
484 pcg 1.1 {
485 pcg 1.22 if (revents & EVENT_READ)
486 pcg 1.1 {
487     vpn_packet *pkt = new vpn_packet;
488     struct sockaddr_in sa;
489     socklen_t sa_len = sizeof (sa);
490     int len;
491    
492 pcg 1.5 len = recvfrom (w.fd, &((*pkt)[0]), MAXSIZE, 0, (sockaddr *)&sa, &sa_len);
493 pcg 1.1
494 pcg 1.9 sockinfo si(sa, PROT_ICMPv4);
495 pcg 1.1
496     if (len > 0)
497     {
498     pkt->len = len;
499    
500 pcg 1.14 icmp_header *hdr = (icmp_header *)&((*pkt)[IP_OVERHEAD]);
501 pcg 1.9
502     if (hdr->type == ::conf.icmp_type
503     && hdr->code == 255)
504     {
505     // raw sockets deliver the ipv4, but don't expect it on sends
506     // this is slow, but...
507     pkt->skip_hdr (ICMP_OVERHEAD);
508    
509     recv_vpn_packet (pkt, si);
510     }
511     }
512     else
513     {
514     // probably ECONNRESET or somesuch
515     slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));
516     }
517    
518     delete pkt;
519     }
520     else
521     {
522     slog (L_ERR,
523     _("FATAL: unknown revents %08x in socket, terminating\n"),
524     revents);
525 pcg 1.23 exit (EXIT_FAILURE);
526 pcg 1.9 }
527     }
528 pcg 1.13 #endif
529 pcg 1.9
530     void
531     vpn::udpv4_ev (io_watcher &w, short revents)
532     {
533 pcg 1.22 if (revents & EVENT_READ)
534 pcg 1.9 {
535     vpn_packet *pkt = new vpn_packet;
536     struct sockaddr_in sa;
537     socklen_t sa_len = sizeof (sa);
538     int len;
539    
540     len = recvfrom (w.fd, &((*pkt)[0]), MAXSIZE, 0, (sockaddr *)&sa, &sa_len);
541    
542     sockinfo si(sa, PROT_UDPv4);
543    
544     if (len > 0)
545     {
546     pkt->len = len;
547 pcg 1.1
548     recv_vpn_packet (pkt, si);
549     }
550     else
551     {
552     // probably ECONNRESET or somesuch
553 pcg 1.9 slog (L_DEBUG, _("%s: fd %d, %s"), (const char *)si, w.fd, strerror (errno));
554 pcg 1.1 }
555    
556     delete pkt;
557     }
558     else
559     {
560     slog (L_ERR,
561     _("FATAL: unknown revents %08x in socket, terminating\n"),
562     revents);
563 pcg 1.23 exit (EXIT_FAILURE);
564 pcg 1.1 }
565     }
566 pcg 1.2
567     void
568 pcg 1.3 vpn::tap_ev (io_watcher &w, short revents)
569 pcg 1.1 {
570 pcg 1.22 if (revents & EVENT_READ)
571 pcg 1.1 {
572     /* process data */
573     tap_packet *pkt;
574    
575     pkt = tap->recv ();
576    
577 pcg 1.17 if (!pkt)
578     return;
579 pcg 1.1
580 pcg 1.17 if (pkt->len > 14)
581 pcg 1.1 {
582 pcg 1.17 int dst = mac2id (pkt->dst);
583     int src = mac2id (pkt->src);
584 pcg 1.1
585 pcg 1.17 if (src != THISNODE->id)
586     {
587 pcg 1.30 slog (L_ERR, _("FATAL: tap packet not originating on current node received (if-up script not working properly?), exiting."));
588 pcg 1.23 exit (EXIT_FAILURE);
589 pcg 1.17 }
590 pcg 1.1
591 pcg 1.17 if (dst == THISNODE->id)
592 pcg 1.1 {
593 pcg 1.17 slog (L_ERR, _("FATAL: tap packet destined for current node received, exiting."));
594 pcg 1.23 exit (EXIT_FAILURE);
595 pcg 1.1 }
596 pcg 1.17
597     if (dst > conns.size ())
598     slog (L_ERR, _("tap packet for unknown node %d received, ignoring."), dst);
599 pcg 1.1 else
600 pcg 1.18 inject_data_packet (pkt, dst);
601 pcg 1.1 }
602    
603     delete pkt;
604     }
605     else
606     abort ();
607     }
608    
609     void
610 pcg 1.3 vpn::event_cb (time_watcher &w)
611 pcg 1.1 {
612     if (events)
613     {
614     if (events & EVENT_SHUTDOWN)
615     {
616     slog (L_INFO, _("preparing shutdown..."));
617    
618     shutdown_all ();
619 pcg 1.24 remove_pid (conf.pidfilename);
620 pcg 1.1 slog (L_INFO, _("terminating"));
621 pcg 1.23 exit (EXIT_SUCCESS);
622 pcg 1.1 }
623    
624     if (events & EVENT_RECONNECT)
625     {
626     slog (L_INFO, _("forced reconnect"));
627    
628     reconnect_all ();
629     }
630    
631     events = 0;
632     }
633     }
634    
635     void
636     vpn::shutdown_all ()
637     {
638     for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
639     (*c)->shutdown ();
640     }
641    
642     void
643     vpn::reconnect_all ()
644     {
645     for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
646     delete *c;
647    
648     conns.clear ();
649    
650     connection_init ();
651    
652     for (configuration::node_vector::iterator i = conf.nodes.begin ();
653     i != conf.nodes.end (); ++i)
654     {
655 pcg 1.27 connection *conn = new connection (this, *i);
656 pcg 1.1 conns.push_back (conn);
657     conn->establish_connection ();
658     }
659     }
660    
661     connection *vpn::find_router ()
662     {
663 pcg 1.26 u32 prio = 1;
664 pcg 1.1 connection *router = 0;
665    
666     for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
667     {
668     connection *c = *i;
669    
670 pcg 1.13 if (c->conf->routerprio > prio
671 pcg 1.11 && c->connectmode == conf_node::C_ALWAYS // so we don't drop the connection if in use
672     && c->ictx && c->octx
673 pcg 1.13 && c->conf != THISNODE) // redundant, since ictx==octx==0 always on thisnode
674 pcg 1.1 {
675     prio = c->conf->routerprio;
676     router = c;
677     }
678     }
679    
680     return router;
681     }
682    
683 pcg 1.7 void vpn::send_connect_request (int id)
684 pcg 1.1 {
685     connection *c = find_router ();
686    
687     if (c)
688 pcg 1.7 c->send_connect_request (id);
689     else
690     // no router found, aggressively connect to all routers
691     for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
692 pcg 1.13 if ((*i)->conf->routerprio && (*i)->conf != THISNODE)
693 pcg 1.7 (*i)->establish_connection ();
694 pcg 1.1 }
695    
696     void
697     connection::dump_status ()
698     {
699     slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);
700     slog (L_NOTICE, _(" connectmode %d (%d) / sockaddr %s / minor %d"),
701     connectmode, conf->connectmode, (const char *)si, (int)prot_minor);
702     slog (L_NOTICE, _(" ictx/octx %08lx/%08lx / oseqno %d / retry_cnt %d"),
703     (long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);
704     slog (L_NOTICE, _(" establish_conn %ld / rekey %ld / keepalive %ld"),
705     (long)(establish_connection.at), (long)(rekey.at), (long)(keepalive.at));
706     }
707    
708     void
709     vpn::dump_status ()
710     {
711     slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)NOW);
712    
713     for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
714     (*c)->dump_status ();
715    
716     slog (L_NOTICE, _("END status dump"));
717     }
718    
719     vpn::vpn (void)
720 pcg 1.9 : event (this, &vpn::event_cb)
721     , udpv4_ev_watcher (this, &vpn::udpv4_ev)
722     , ipv4_ev_watcher (this, &vpn::ipv4_ev)
723 pcg 1.2 #if ENABLE_TCP
724 pcg 1.9 , tcpv4_ev_watcher (this, &vpn::tcpv4_ev)
725     #endif
726     #if ENABLE_ICMP
727     , icmpv4_ev_watcher(this, &vpn::icmpv4_ev)
728 pcg 1.24 #endif
729     #if ENABLE_DNS
730     , dnsv4_ev_watcher (this, &vpn::dnsv4_ev)
731 pcg 1.2 #endif
732 pcg 1.9 , tap_ev_watcher (this, &vpn::tap_ev)
733 pcg 1.1 {
734     }
735    
736     vpn::~vpn ()
737     {
738     }
739