ViewVC Help
View File | Revision Log | Show Annotations | Download File
/cvs/gvpe/src/vpn.C
Revision: 1.31
Committed: Sat Mar 5 19:13:16 2005 UTC (19 years, 2 months ago) by pcg
Content type: text/plain
Branch: MAIN
Changes since 1.30: +33 -2 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     // standard daemon practise...
241     {
242     int oval = 1;
243 pcg 1.31 setsockopt (dnsv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
244 pcg 1.24 }
245    
246 pcg 1.31 sockinfo si (THISNODE->dns_hostname,
247     THISNODE->dns_hostname ? THISNODE->dns_port : 0,
248     PROT_DNSv4);
249 pcg 1.24
250     if (bind (dnsv4_fd, si.sav4 (), si.salenv4 ()))
251     {
252     slog (L_ERR, _("can't bind dnsv4 on %s: %s"), (const char *)si, strerror (errno));
253     exit (EXIT_FAILURE);
254     }
255    
256     dnsv4_ev_watcher.start (dnsv4_fd, EVENT_READ);
257     }
258     #endif
259    
260 pcg 1.1 tap = new tap_device ();
261     if (!tap) //D this, of course, never catches
262     {
263     slog (L_ERR, _("cannot create network interface '%s'"), conf.ifname);
264 pcg 1.23 exit (EXIT_FAILURE);
265 pcg 1.1 }
266    
267     run_script (run_script_cb (this, &vpn::script_if_up), true);
268    
269 pcg 1.22 tap_ev_watcher.start (tap->fd, EVENT_READ);
270 pcg 1.1
271     reconnect_all ();
272    
273     return 0;
274     }
275    
276 pcg 1.7 bool
277 pcg 1.1 vpn::send_ipv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
278     {
279 pcg 1.14 #if defined(SOL_IP) && defined(IP_TOS)
280 pcg 1.1 setsockopt (ipv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
281 pcg 1.14 #endif
282 pcg 1.1 sendto (ipv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
283 pcg 1.7
284     return true;
285 pcg 1.1 }
286    
287 pcg 1.9 static u16
288     ipv4_checksum (u16 *data, unsigned int len)
289     {
290     // use 32 bit accumulator and fold back carry bits at the end
291     u32 sum = 0;
292    
293     while (len > 1)
294     {
295     sum += *data++;
296     len -= 2;
297     }
298    
299     // odd byte left?
300     if (len)
301     sum += *(u8 *)data;
302    
303     // add back carry bits
304     sum = (sum >> 16) + (sum & 0xffff); // lo += hi
305     sum += (sum >> 16); // carry
306    
307     return ~sum;
308     }
309    
310 pcg 1.13 #if ENABLE_ICMP
311 pcg 1.9 bool
312     vpn::send_icmpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
313     {
314 pcg 1.14 #if defined(SOL_IP) && defined(IP_TOS)
315 pcg 1.9 setsockopt (icmpv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
316 pcg 1.14 #endif
317 pcg 1.9
318     pkt->unshift_hdr (4);
319    
320 pcg 1.14 icmp_header *hdr = (icmp_header *)&((*pkt)[0]);
321 pcg 1.9 hdr->type = ::conf.icmp_type;
322     hdr->code = 255;
323     hdr->checksum = 0;
324     hdr->checksum = ipv4_checksum ((u16 *)hdr, pkt->len);
325    
326     sendto (icmpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
327    
328     return true;
329     }
330 pcg 1.13 #endif
331 pcg 1.9
332 pcg 1.7 bool
333 pcg 1.1 vpn::send_udpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
334     {
335 pcg 1.14 #if defined(SOL_IP) && defined(IP_TOS)
336 pcg 1.1 setsockopt (udpv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
337 pcg 1.14 #endif
338 pcg 1.1 sendto (udpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
339 pcg 1.7
340     return true;
341 pcg 1.1 }
342    
343     void
344 pcg 1.18 vpn::inject_data_packet (tap_packet *pkt, int dst)
345     {
346     if (dst)
347     {
348     // unicast
349     if (dst != THISNODE->id)
350     conns[dst - 1]->inject_data_packet (pkt);
351     }
352     else
353     {
354     // broadcast, this is ugly, but due to the security policy
355     // we have to connect to all hosts...
356     for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
357     if ((*c)->conf != THISNODE)
358     (*c)->inject_data_packet (pkt, true);
359     }
360     }
361    
362     void
363 pcg 1.1 vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)
364     {
365     unsigned int src = pkt->src ();
366     unsigned int dst = pkt->dst ();
367    
368     slog (L_NOISE, _("<<?/%s received possible vpn packet type %d from %d to %d, length %d"),
369     (const char *)rsi, pkt->typ (), pkt->src (), pkt->dst (), pkt->len);
370    
371     if (src == 0 || src > conns.size ()
372     || dst > conns.size ()
373     || pkt->typ () >= vpn_packet::PT_MAX)
374     slog (L_WARN, _("(%s): received corrupted packet type %d (src %d, dst %d)"),
375     (const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
376 pcg 1.6 else if (dst > conns.size ())
377     slog (L_WARN, _("(%s): received corrupted packet type %d (src %d, dst %d)"),
378     (const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
379 pcg 1.1 else
380     {
381     connection *c = conns[src - 1];
382    
383 pcg 1.13 if (dst == 0)
384     slog (L_WARN, _("%s(%s): received broadcast (protocol violation)"),
385 pcg 1.1 c->conf->nodename, (const char *)rsi);
386 pcg 1.18 else if (dst != THISNODE->id)
387 pcg 1.6 {
388     if (THISNODE->routerprio)
389     // the tos setting gets lost here. who cares.
390     conns[dst - 1]->inject_vpn_packet (pkt);
391     else
392     slog (L_WARN,
393     _("%s(%s): forwarding request (=> %s), but we are no router"),
394     c->conf->nodename, (const char *)rsi,
395     conns[dst - 1]->conf->nodename);
396     }
397 pcg 1.1 else
398     c->recv_vpn_packet (pkt, rsi);
399     }
400     }
401    
402 pcg 1.31 bool
403     vpn::send_vpn_packet (vpn_packet *pkt, const sockinfo &si, int tos)
404     {
405     switch (si.prot)
406     {
407     case PROT_IPv4:
408     return send_ipv4_packet (pkt, si, tos);
409     case PROT_UDPv4:
410     return send_udpv4_packet (pkt, si, tos);
411     #if ENABLE_TCP
412     case PROT_TCPv4:
413     return send_tcpv4_packet (pkt, si, tos);
414     #endif
415     #if ENABLE_ICMP
416     case PROT_ICMPv4:
417     return send_icmpv4_packet (pkt, si, tos);
418     #endif
419     #if ENABLE_DNS
420     case PROT_DNSv4:
421     return send_dnsv4_packet (pkt, si, tos);
422     #endif
423    
424     default:
425     slog (L_CRIT, _("%s: FATAL: trying to send packet with unsupported protocol"), (const char *)si);
426     }
427    
428     return false;
429     }
430    
431 pcg 1.1 void
432 pcg 1.9 vpn::ipv4_ev (io_watcher &w, short revents)
433 pcg 1.1 {
434 pcg 1.22 if (revents & EVENT_READ)
435 pcg 1.1 {
436     vpn_packet *pkt = new vpn_packet;
437     struct sockaddr_in sa;
438     socklen_t sa_len = sizeof (sa);
439     int len;
440    
441 pcg 1.5 len = recvfrom (w.fd, &((*pkt)[0]), MAXSIZE, 0, (sockaddr *)&sa, &sa_len);
442 pcg 1.1
443 pcg 1.9 sockinfo si(sa, PROT_IPv4);
444 pcg 1.1
445     if (len > 0)
446     {
447     pkt->len = len;
448    
449 pcg 1.30 // raw sockets deliver the ipv4 header, but don't expect it on sends
450 pcg 1.9 pkt->skip_hdr (IP_OVERHEAD);
451    
452 pcg 1.1 recv_vpn_packet (pkt, si);
453     }
454     else
455     {
456     // probably ECONNRESET or somesuch
457 pcg 1.9 slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));
458 pcg 1.1 }
459    
460     delete pkt;
461     }
462     else
463     {
464     slog (L_ERR,
465 pcg 1.30 _("FATAL: unknown revents %08x in socket, terminating\n"),
466     revents);
467 pcg 1.23 exit (EXIT_FAILURE);
468 pcg 1.1 }
469     }
470    
471 pcg 1.13 #if ENABLE_ICMP
472 pcg 1.1 void
473 pcg 1.9 vpn::icmpv4_ev (io_watcher &w, short revents)
474 pcg 1.1 {
475 pcg 1.22 if (revents & EVENT_READ)
476 pcg 1.1 {
477     vpn_packet *pkt = new vpn_packet;
478     struct sockaddr_in sa;
479     socklen_t sa_len = sizeof (sa);
480     int len;
481    
482 pcg 1.5 len = recvfrom (w.fd, &((*pkt)[0]), MAXSIZE, 0, (sockaddr *)&sa, &sa_len);
483 pcg 1.1
484 pcg 1.9 sockinfo si(sa, PROT_ICMPv4);
485 pcg 1.1
486     if (len > 0)
487     {
488     pkt->len = len;
489    
490 pcg 1.14 icmp_header *hdr = (icmp_header *)&((*pkt)[IP_OVERHEAD]);
491 pcg 1.9
492     if (hdr->type == ::conf.icmp_type
493     && hdr->code == 255)
494     {
495     // raw sockets deliver the ipv4, but don't expect it on sends
496     // this is slow, but...
497     pkt->skip_hdr (ICMP_OVERHEAD);
498    
499     recv_vpn_packet (pkt, si);
500     }
501     }
502     else
503     {
504     // probably ECONNRESET or somesuch
505     slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));
506     }
507    
508     delete pkt;
509     }
510     else
511     {
512     slog (L_ERR,
513     _("FATAL: unknown revents %08x in socket, terminating\n"),
514     revents);
515 pcg 1.23 exit (EXIT_FAILURE);
516 pcg 1.9 }
517     }
518 pcg 1.13 #endif
519 pcg 1.9
520     void
521     vpn::udpv4_ev (io_watcher &w, short revents)
522     {
523 pcg 1.22 if (revents & EVENT_READ)
524 pcg 1.9 {
525     vpn_packet *pkt = new vpn_packet;
526     struct sockaddr_in sa;
527     socklen_t sa_len = sizeof (sa);
528     int len;
529    
530     len = recvfrom (w.fd, &((*pkt)[0]), MAXSIZE, 0, (sockaddr *)&sa, &sa_len);
531    
532     sockinfo si(sa, PROT_UDPv4);
533    
534     if (len > 0)
535     {
536     pkt->len = len;
537 pcg 1.1
538     recv_vpn_packet (pkt, si);
539     }
540     else
541     {
542     // probably ECONNRESET or somesuch
543 pcg 1.9 slog (L_DEBUG, _("%s: fd %d, %s"), (const char *)si, w.fd, strerror (errno));
544 pcg 1.1 }
545    
546     delete pkt;
547     }
548     else
549     {
550     slog (L_ERR,
551     _("FATAL: unknown revents %08x in socket, terminating\n"),
552     revents);
553 pcg 1.23 exit (EXIT_FAILURE);
554 pcg 1.1 }
555     }
556 pcg 1.2
557     void
558 pcg 1.3 vpn::tap_ev (io_watcher &w, short revents)
559 pcg 1.1 {
560 pcg 1.22 if (revents & EVENT_READ)
561 pcg 1.1 {
562     /* process data */
563     tap_packet *pkt;
564    
565     pkt = tap->recv ();
566    
567 pcg 1.17 if (!pkt)
568     return;
569 pcg 1.1
570 pcg 1.17 if (pkt->len > 14)
571 pcg 1.1 {
572 pcg 1.17 int dst = mac2id (pkt->dst);
573     int src = mac2id (pkt->src);
574 pcg 1.1
575 pcg 1.17 if (src != THISNODE->id)
576     {
577 pcg 1.30 slog (L_ERR, _("FATAL: tap packet not originating on current node received (if-up script not working properly?), exiting."));
578 pcg 1.23 exit (EXIT_FAILURE);
579 pcg 1.17 }
580 pcg 1.1
581 pcg 1.17 if (dst == THISNODE->id)
582 pcg 1.1 {
583 pcg 1.17 slog (L_ERR, _("FATAL: tap packet destined for current node received, exiting."));
584 pcg 1.23 exit (EXIT_FAILURE);
585 pcg 1.1 }
586 pcg 1.17
587     if (dst > conns.size ())
588     slog (L_ERR, _("tap packet for unknown node %d received, ignoring."), dst);
589 pcg 1.1 else
590 pcg 1.18 inject_data_packet (pkt, dst);
591 pcg 1.1 }
592    
593     delete pkt;
594     }
595     else
596     abort ();
597     }
598    
599     void
600 pcg 1.3 vpn::event_cb (time_watcher &w)
601 pcg 1.1 {
602     if (events)
603     {
604     if (events & EVENT_SHUTDOWN)
605     {
606     slog (L_INFO, _("preparing shutdown..."));
607    
608     shutdown_all ();
609 pcg 1.24 remove_pid (conf.pidfilename);
610 pcg 1.1 slog (L_INFO, _("terminating"));
611 pcg 1.23 exit (EXIT_SUCCESS);
612 pcg 1.1 }
613    
614     if (events & EVENT_RECONNECT)
615     {
616     slog (L_INFO, _("forced reconnect"));
617    
618     reconnect_all ();
619     }
620    
621     events = 0;
622     }
623     }
624    
625     void
626     vpn::shutdown_all ()
627     {
628     for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
629     (*c)->shutdown ();
630     }
631    
632     void
633     vpn::reconnect_all ()
634     {
635     for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
636     delete *c;
637    
638     conns.clear ();
639    
640     connection_init ();
641    
642     for (configuration::node_vector::iterator i = conf.nodes.begin ();
643     i != conf.nodes.end (); ++i)
644     {
645 pcg 1.27 connection *conn = new connection (this, *i);
646 pcg 1.1 conns.push_back (conn);
647     conn->establish_connection ();
648     }
649     }
650    
651     connection *vpn::find_router ()
652     {
653 pcg 1.26 u32 prio = 1;
654 pcg 1.1 connection *router = 0;
655    
656     for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
657     {
658     connection *c = *i;
659    
660 pcg 1.13 if (c->conf->routerprio > prio
661 pcg 1.11 && c->connectmode == conf_node::C_ALWAYS // so we don't drop the connection if in use
662     && c->ictx && c->octx
663 pcg 1.13 && c->conf != THISNODE) // redundant, since ictx==octx==0 always on thisnode
664 pcg 1.1 {
665     prio = c->conf->routerprio;
666     router = c;
667     }
668     }
669    
670     return router;
671     }
672    
673 pcg 1.7 void vpn::send_connect_request (int id)
674 pcg 1.1 {
675     connection *c = find_router ();
676    
677     if (c)
678 pcg 1.7 c->send_connect_request (id);
679     else
680     // no router found, aggressively connect to all routers
681     for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
682 pcg 1.13 if ((*i)->conf->routerprio && (*i)->conf != THISNODE)
683 pcg 1.7 (*i)->establish_connection ();
684 pcg 1.1 }
685    
686     void
687     connection::dump_status ()
688     {
689     slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);
690     slog (L_NOTICE, _(" connectmode %d (%d) / sockaddr %s / minor %d"),
691     connectmode, conf->connectmode, (const char *)si, (int)prot_minor);
692     slog (L_NOTICE, _(" ictx/octx %08lx/%08lx / oseqno %d / retry_cnt %d"),
693     (long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);
694     slog (L_NOTICE, _(" establish_conn %ld / rekey %ld / keepalive %ld"),
695     (long)(establish_connection.at), (long)(rekey.at), (long)(keepalive.at));
696     }
697    
698     void
699     vpn::dump_status ()
700     {
701     slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)NOW);
702    
703     for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
704     (*c)->dump_status ();
705    
706     slog (L_NOTICE, _("END status dump"));
707     }
708    
709     vpn::vpn (void)
710 pcg 1.9 : event (this, &vpn::event_cb)
711     , udpv4_ev_watcher (this, &vpn::udpv4_ev)
712     , ipv4_ev_watcher (this, &vpn::ipv4_ev)
713 pcg 1.2 #if ENABLE_TCP
714 pcg 1.9 , tcpv4_ev_watcher (this, &vpn::tcpv4_ev)
715     #endif
716     #if ENABLE_ICMP
717     , icmpv4_ev_watcher(this, &vpn::icmpv4_ev)
718 pcg 1.24 #endif
719     #if ENABLE_DNS
720     , dnsv4_ev_watcher (this, &vpn::dnsv4_ev)
721 pcg 1.2 #endif
722 pcg 1.9 , tap_ev_watcher (this, &vpn::tap_ev)
723 pcg 1.1 {
724     }
725    
726     vpn::~vpn ()
727     {
728     }
729