ViewVC Help
View File | Revision Log | Show Annotations | Download File
/cvs/gvpe/src/vpn.C
(Generate patch)

Comparing gvpe/src/vpn.C (file contents):
Revision 1.19 by pcg, Thu Oct 16 02:41:21 2003 UTC vs.
Revision 1.69 by root, Sat Sep 5 17:40:22 2015 UTC

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

Diff Legend

Removed lines
+ Added lines
< Changed lines
> Changed lines