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

Diff Legend

Removed lines
+ Added lines
< Changed lines
> Changed lines