[ViewVC] Diff of: cvs/gvpe/src/vpn.C

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

Diff Legend

-–
+Removed lines
-+
+Added lines
-<
+Changed lines
->
+Changed lines

Comparing gvpe/src/vpn.C (file contents): Revision 1.1 by pcg, Wed Apr 2 03:25:17 2003 UTC vs. Revision 1.62 by root, Sat Dec 17 22:05:34 2011 UTC

Diff Legend

Comparing gvpe/src/vpn.C (file contents):
Revision 1.1 by pcg, Wed Apr 2 03:25:17 2003 UTC vs.
Revision 1.62 by root, Sat Dec 17 22:05:34 2011 UTC