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

Comparing gvpe/src/vpn.C (file contents):
Revision 1.3 by pcg, Wed Apr 2 21:02:25 2003 UTC vs.
Revision 1.47 by pcg, Thu Aug 7 17:54:27 2008 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 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
43	#if ENABLE_TCP	57	vpn network; // THE vpn (bad design...)
44	# include <map>
45	# include <unistd.h>
46	# include <fcntl.h>
47	# include <sys/poll.h>
48	#endif
49		58
50	/////////////////////////////////////////////////////////////////////////////	59	/////////////////////////////////////////////////////////////////////////////
51		60
52	const char *vpn::script_if_up ()	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 ()
53	{	75	{
54	// the tunnel device mtu should be the physical mtu - overhead	76	// the tunnel device mtu should be the physical mtu - overhead
55	// the tricky part is rounding to the cipher key blocksize	77	// the tricky part is rounding to the cipher key blocksize
56	int mtu = conf.mtu - ETH_OVERHEAD - VPE_OVERHEAD - MAX_OVERHEAD;	78	int mtu = conf.mtu - ETH_OVERHEAD - VPE_OVERHEAD - MAX_OVERHEAD;
57	mtu += ETH_OVERHEAD - 6 - 6; // now we have the data portion	79	mtu += ETH_OVERHEAD - 6 - 6; // now we have the data portion
58	mtu -= mtu % EVP_CIPHER_block_size (CIPHER); // round	80	mtu -= mtu % EVP_CIPHER_block_size (CIPHER); // round
59	mtu -= ETH_OVERHEAD - 6 - 6; // and get interface mtu again	81	mtu -= ETH_OVERHEAD - 6 - 6; // and get interface mtu again
60		82
61	char *env;	83	char *env;
62	asprintf (&env, "CONFBASE=%s", confbase);	84	asprintf (&env, "CONFBASE=%s", confbase); putenv (env);
63	putenv (env);
64	asprintf (&env, "NODENAME=%s", THISNODE->nodename);
65	putenv (env);
66	asprintf (&env, "NODEID=%d", THISNODE->id);
67	putenv (env);
68	asprintf (&env, "IFNAME=%s", tap->interface ());	85	asprintf (&env, "IFNAME=%s", tap->interface ()); putenv (env);
69	putenv (env);	86	asprintf (&env, "IFTYPE=%s", IFTYPE); putenv (env);
		87	asprintf (&env, "IFSUBTYPE=%s", IFSUBTYPE); putenv (env);
70	asprintf (&env, "MTU=%d", mtu);	88	asprintf (&env, "MTU=%d", mtu); putenv (env);
71	putenv (env);	89	asprintf (&env, "NODES=%d", conns.size ()); putenv (env);
72	asprintf (&env, "MAC=%02x:%02x:%02x:%02x:%02x:%02x",	90	asprintf (&env, "NODEID=%d", THISNODE->id); putenv (env);
73	0xfe, 0xfd, 0x80, 0x00, THISNODE->id >> 8,
74	THISNODE->id & 0xff);
75	putenv (env);
76		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,
77	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;
78	}	122	}
79		123
80	int	124	int
81	vpn::setup ()	125	vpn::setup ()
82	{	126	{
		127	ipv4_tos = -1;
		128	ipv4_fd = -1;
		129
		130	if (THISNODE->protocols & PROT_IPv4 && ::conf.ip_proto)
		131	{
		132	ipv4_fd = socket (PF_INET, SOCK_RAW, ::conf.ip_proto);
		133
		134	if (ipv4_fd < 0)
		135	return -1;
		136
		137	fcntl (ipv4_fd, F_SETFL, O_NONBLOCK);
		138	fcntl (ipv4_fd, F_SETFD, FD_CLOEXEC);
		139
		140	#if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
		141	// this I really consider a linux bug. I am neither connected
		142	// nor do I fragment myself. Linux still sets DF and doesn't
		143	// fragment for me sometimes.
		144	{
		145	int oval = IP_PMTUDISC_DONT;
		146	setsockopt (ipv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
		147	}
		148	#endif
		149
		150	sockinfo si (THISNODE, PROT_IPv4);
		151
		152	if (bind (ipv4_fd, si.sav4 (), si.salenv4 ()))
		153	{
		154	slog (L_ERR, _("can't bind ipv4 socket on %s: %s"), (const char *)si, strerror (errno));
		155	exit (EXIT_FAILURE);
		156	}
		157
		158	ipv4_ev_watcher.start (ipv4_fd, EV_READ);
		159	}
		160
		161	udpv4_tos = -1;
83	udpv4_fd = -1;	162	udpv4_fd = -1;
84		163
85	if (THISNODE->protocols & PROT_UDPv4)	164	if (THISNODE->protocols & PROT_UDPv4 && THISNODE->udp_port)
86	{	165	{
87	udpv4_fd = socket (PF_INET, SOCK_DGRAM, IPPROTO_UDP);	166	udpv4_fd = socket (PF_INET, SOCK_DGRAM, IPPROTO_UDP);
88		167
89	if (udpv4_fd < 0)	168	if (udpv4_fd < 0)
90	return -1;	169	return -1;
		170
		171	fcntl (udpv4_fd, F_SETFL, O_NONBLOCK);
		172	fcntl (udpv4_fd, F_SETFD, FD_CLOEXEC);
91		173
92	// standard daemon practise...	174	// standard daemon practise...
93	{	175	{
94	int oval = 1;	176	int oval = 1;
95	setsockopt (udpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);	177	setsockopt (udpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
96	}	178	}
97		179
98	sockinfo si (THISNODE, PROT_UDPv4);	180	#if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
99
100	if (bind (udpv4_fd, si.sav4 (), si.salenv4 ()))
101	{
102	slog (L_ERR, _("can't bind udpv4 on %s: %s"), (const char *)si, strerror (errno));
103	exit (1);
104	}
105
106	#ifdef IP_MTU_DISCOVER
107	// this I really consider a linux bug. I am neither connected	181	// this I really consider a linux bug. I am neither connected
108	// nor do I fragment myself. Linux still sets DF and doesn't	182	// nor do I fragment myself. Linux still sets DF and doesn't
109	// fragment for me sometimes.	183	// fragment for me sometimes.
110	{	184	{
111	int oval = IP_PMTUDISC_DONT;	185	int oval = IP_PMTUDISC_DONT;
112	setsockopt (udpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);	186	setsockopt (udpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
113	}	187	}
114	#endif	188	#endif
115		189
		190	sockinfo si (THISNODE, PROT_UDPv4);
		191
		192	if (bind (udpv4_fd, si.sav4 (), si.salenv4 ()))
		193	{
		194	slog (L_ERR, _("can't bind udpv4 on %s: %s"), (const char *)si, strerror (errno));
		195	exit (EXIT_FAILURE);
		196	}
		197
116	udpv4_ev_watcher.start (udpv4_fd, POLLIN);	198	udpv4_ev_watcher.start (udpv4_fd, EV_READ);
117	}	199	}
118		200
		201	icmpv4_tos = -1;
119	ipv4_fd = -1;	202	icmpv4_fd = -1;
		203
		204	#if ENABLE_ICMP
120	if (THISNODE->protocols & PROT_IPv4)	205	if (THISNODE->protocols & PROT_ICMPv4)
121	{	206	{
122	ipv4_fd = socket (PF_INET, SOCK_RAW, ::conf.ip_proto);	207	icmpv4_fd = socket (PF_INET, SOCK_RAW, IPPROTO_ICMP);
123		208
124	if (ipv4_fd < 0)	209	if (icmpv4_fd < 0)
125	return -1;	210	return -1;
126		211
127	sockinfo si (THISNODE, PROT_IPv4);	212	fcntl (icmpv4_fd, F_SETFL, O_NONBLOCK);
		213	fcntl (icmpv4_fd, F_SETFD, FD_CLOEXEC);
128		214
129	if (bind (ipv4_fd, si.sav4 (), si.salenv4 ()))	215	#ifdef ICMP_FILTER
130	{	216	{
131	slog (L_ERR, _("can't bind ipv4 socket on %s: %s"), (const char *)si, strerror (errno));	217	icmp_filter oval;
132	exit (1);	218	oval.data = 0xffffffff;
		219	if (::conf.icmp_type < 32)
		220	oval.data &= ~(1 << ::conf.icmp_type);
		221
		222	setsockopt (icmpv4_fd, SOL_RAW, ICMP_FILTER, &oval, sizeof oval);
133	}	223	}
		224	#endif
134		225
135	#ifdef IP_MTU_DISCOVER	226	#if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
136	// this I really consider a linux bug. I am neither connected	227	// this I really consider a linux bug. I am neither connected
137	// nor do I fragment myself. Linux still sets DF and doesn't	228	// nor do I fragment myself. Linux still sets DF and doesn't
138	// fragment for me sometimes.	229	// fragment for me sometimes.
139	{	230	{
140	int oval = IP_PMTUDISC_DONT;	231	int oval = IP_PMTUDISC_DONT;
141	setsockopt (ipv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);	232	setsockopt (icmpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
142	}	233	}
143	#endif	234	#endif
144		235
		236	sockinfo si (THISNODE, PROT_ICMPv4);
		237
		238	if (bind (icmpv4_fd, si.sav4 (), si.salenv4 ()))
		239	{
		240	slog (L_ERR, _("can't bind icmpv4 on %s: %s"), (const char *)si, strerror (errno));
		241	exit (EXIT_FAILURE);
		242	}
		243
145	ipv4_ev_watcher.start (ipv4_fd, POLLIN);	244	icmpv4_ev_watcher.start (icmpv4_fd, EV_READ);
146	}	245	}
		246	#endif
		247
		248	tcpv4_fd = -1;
147		249
148	#if ENABLE_TCP	250	#if ENABLE_TCP
149	if (THISNODE->protocols & PROT_TCPv4)	251	if (THISNODE->protocols & PROT_TCPv4 && THISNODE->tcp_port)
150	{	252	{
151	tcpv4_fd = socket (PF_INET, SOCK_STREAM, IPPROTO_TCP);	253	tcpv4_fd = socket (PF_INET, SOCK_STREAM, IPPROTO_TCP);
152		254
153	if (tcpv4_fd < 0)	255	if (tcpv4_fd < 0)
154	return -1;	256	return -1;
		257
		258	fcntl (tcpv4_fd, F_SETFL, O_NONBLOCK);
		259	fcntl (tcpv4_fd, F_SETFD, FD_CLOEXEC);
155		260
156	// standard daemon practise...	261	// standard daemon practise...
157	{	262	{
158	int oval = 1;	263	int oval = 1;
159	setsockopt (tcpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);	264	setsockopt (tcpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
162	sockinfo si (THISNODE, PROT_TCPv4);	267	sockinfo si (THISNODE, PROT_TCPv4);
163		268
164	if (bind (tcpv4_fd, si.sav4 (), si.salenv4 ()))	269	if (bind (tcpv4_fd, si.sav4 (), si.salenv4 ()))
165	{	270	{
166	slog (L_ERR, _("can't bind tcpv4 on %s: %s"), (const char *)si, strerror (errno));	271	slog (L_ERR, _("can't bind tcpv4 on %s: %s"), (const char *)si, strerror (errno));
167	exit (1);	272	exit (EXIT_FAILURE);
168	}	273	}
169		274
170	if (listen (tcpv4_fd, 5))	275	if (listen (tcpv4_fd, 5))
171	{	276	{
172	slog (L_ERR, _("can't listen tcpv4 on %s: %s"), (const char *)si, strerror (errno));	277	slog (L_ERR, _("can't listen tcpv4 on %s: %s"), (const char *)si, strerror (errno));
173	exit (1);	278	exit (EXIT_FAILURE);
		279	}
		280
		281	tcpv4_ev_watcher.start (tcpv4_fd, EV_READ);
		282	}
		283	#endif
		284
		285	dnsv4_tos = -1;
		286	dnsv4_fd = -1;
		287
		288	#if ENABLE_DNS
		289	if (THISNODE->protocols & PROT_DNSv4)
		290	{
		291	dns_forwarder.set (::conf.dns_forw_host, ::conf.dns_forw_port, PROT_DNSv4);
		292
		293	dnsv4_fd = socket (PF_INET, SOCK_DGRAM, IPPROTO_UDP);
		294
		295	if (dnsv4_fd < 0)
		296	return -1;
		297
		298	fcntl (dnsv4_fd, F_SETFL, O_NONBLOCK);
		299	fcntl (dnsv4_fd, F_SETFD, FD_CLOEXEC);
		300
		301	# if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
		302	// this I really consider a linux bug. I am neither connected
		303	// nor do I fragment myself. Linux still sets DF and doesn't
		304	// fragment for me sometimes.
		305	{
		306	int oval = IP_PMTUDISC_DONT;
		307	setsockopt (dnsv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
174	}	308	}
175
176	tcpv4_ev_watcher.start (tcpv4_fd, POLLIN);
177	}
178	#endif	309	# endif
		310
		311	// standard daemon practise...
		312	{
		313	int oval = 1;
		314	setsockopt (dnsv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
		315	}
		316
		317	sockinfo si (THISNODE->dns_hostname,
		318	THISNODE->dns_hostname ? THISNODE->dns_port : 0,
		319	PROT_DNSv4);
		320
		321	if (bind (dnsv4_fd, si.sav4 (), si.salenv4 ()))
		322	{
		323	slog (L_ERR, _("can't bind dnsv4 on %s: %s"), (const char *)si, strerror (errno));
		324	exit (EXIT_FAILURE);
		325	}
		326
		327	dnsv4_ev_watcher.start (dnsv4_fd, EV_READ);
		328	}
		329	#endif
		330
		331	/////////////////////////////////////////////////////////////////////////////
		332
		333	reconnect_all ();
		334
		335	/////////////////////////////////////////////////////////////////////////////
179		336
180	tap = new tap_device ();	337	tap = new tap_device ();
181	if (!tap) //D this, of course, never catches	338	if (!tap) //D this, of course, never catches
182	{	339	{
183	slog (L_ERR, _("cannot create network interface '%s'"), conf.ifname);	340	slog (L_ERR, _("cannot create network interface '%s'"), conf.ifname);
184	exit (1);	341	exit (EXIT_FAILURE);
185	}	342	}
186		343
187	run_script (run_script_cb (this, &vpn::script_if_up), true);	344	fcntl (tap->fd, F_SETFD, FD_CLOEXEC);
188		345
		346	run_script_cb cb;
		347	cb.set<vpn, &vpn::script_if_init> (this);
		348
		349	if (tap->if_up () &&
		350	!run_script (cb, true))
		351	{
		352	slog (L_ERR, _("interface initialization command '%s' failed, exiting."),
		353	tap->if_up ());
		354	exit (EXIT_FAILURE);
		355	}
		356
		357	cb.set<vpn, &vpn::script_if_up> (this);
		358	if (!run_script (cb, true))
		359	{
		360	slog (L_ERR, _("if-up command execution failed, exiting."));
		361	exit (EXIT_FAILURE);
		362	}
		363
189	tap_ev_watcher.start (tap->fd, POLLIN);	364	tap_ev_watcher.start (tap->fd, EV_READ);
190
191	reconnect_all ();
192		365
193	return 0;	366	return 0;
194	}	367	}
195		368
		369	bool
		370	vpn::send_ipv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
		371	{
		372	set_tos (ipv4_fd, ipv4_tos, tos);
		373	sendto (ipv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
		374
		375	return true;
		376	}
		377
		378	static u16
		379	ipv4_checksum (u16 *data, unsigned int len)
		380	{
		381	// use 32 bit accumulator and fold back carry bits at the end
		382	u32 sum = 0;
		383
		384	while (len > 1)
		385	{
		386	sum += *data++;
		387	len -= 2;
		388	}
		389
		390	// odd byte left?
		391	if (len)
		392	sum += (u8 )data;
		393
		394	// add back carry bits
		395	sum = (sum >> 16) + (sum & 0xffff); // lo += hi
		396	sum += (sum >> 16); // carry
		397
		398	return ~sum;
		399	}
		400
		401	#if ENABLE_ICMP
		402	bool
		403	vpn::send_icmpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
		404	{
		405	pkt->unshift_hdr (4);
		406
		407	icmp_header hdr = (icmp_header )&((*pkt)[0]);
		408	hdr->type = ::conf.icmp_type;
		409	hdr->code = 255;
		410	hdr->checksum = 0;
		411	hdr->checksum = ipv4_checksum ((u16 *)hdr, pkt->len);
		412
		413	set_tos (icmpv4_fd, icmpv4_tos, tos);
		414	sendto (icmpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
		415
		416	return true;
		417	}
		418	#endif
		419
		420	bool
		421	vpn::send_udpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
		422	{
		423	set_tos (udpv4_fd, udpv4_tos, tos);
		424	sendto (udpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
		425
		426	return true;
		427	}
		428
196	void	429	void
197	vpn::send_ipv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)	430	vpn::inject_data_packet (tap_packet *pkt, int dst)
198	{	431	{
199	setsockopt (ipv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);	432	if (dst)
200	sendto (ipv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());	433	{
201	}	434	// unicast
202		435	if (dst != THISNODE->id)
203	void	436	conns[dst - 1]->inject_data_packet (pkt);
204	vpn::send_udpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)	437	}
205	{	438	else
206	setsockopt (udpv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);	439	{
207	sendto (udpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());	440	// broadcast, this is ugly, but due to the security policy
		441	// we have to connect to all hosts...
		442	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
		443	if ((*c)->conf != THISNODE)
		444	(*c)->inject_data_packet (pkt);
		445	}
208	}	446	}
209		447
210	void	448	void
211	vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)	449	vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)
212	{	450	{
…		…
219	if (src == 0 \|\| src > conns.size ()	457	if (src == 0 \|\| src > conns.size ()
220	\|\| dst > conns.size ()	458	\|\| dst > conns.size ()
221	\|\| pkt->typ () >= vpn_packet::PT_MAX)	459	\|\| pkt->typ () >= vpn_packet::PT_MAX)
222	slog (L_WARN, _("(%s): received corrupted packet type %d (src %d, dst %d)"),	460	slog (L_WARN, _("(%s): received corrupted packet type %d (src %d, dst %d)"),
223	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());	461	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
		462	else if (dst > conns.size ())
		463	slog (L_WARN, _("(%s): received corrupted packet type %d (src %d, dst %d)"),
		464	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
224	else	465	else
225	{	466	{
226	connection *c = conns[src - 1];	467	connection *c = conns[src - 1];
227		468
228	if (dst == 0 && !THISNODE->routerprio)	469	if (dst == 0)
229	slog (L_WARN, _("%s(%s): received broadcast, but we are no router"),	470	slog (L_WARN, _("%s(%s): received broadcast (protocol violation)"),
230	c->conf->nodename, (const char *)rsi);	471	c->conf->nodename, (const char *)rsi);
231	else if (dst != 0 && dst != THISNODE->id)	472	else if (dst != THISNODE->id)
232	// FORWARDING NEEDED ;)	473	{
		474	if (THISNODE->routerprio)
		475	// the tos setting gets lost here. who cares.
		476	conns[dst - 1]->inject_vpn_packet (pkt);
		477	else
233	slog (L_WARN,	478	slog (L_WARN,
234	_("received frame for node %d ('%s') from %s, but this is node %d ('%s')"),	479	_("%s(%s): forwarding request (=> %s), but we are no router"),
		480	c->conf->nodename, (const char *)rsi,
235	dst, conns[dst - 1]->conf->nodename,	481	conns[dst - 1]->conf->nodename);
236	(const char *)rsi,	482	}
237	THISNODE->id, THISNODE->nodename);
238	else	483	else
239	c->recv_vpn_packet (pkt, rsi);	484	c->recv_vpn_packet (pkt, rsi);
240	}	485	}
241	}	486	}
242		487
243	void	488	bool
244	vpn::udpv4_ev (io_watcher &w, short revents)	489	vpn::send_vpn_packet (vpn_packet *pkt, const sockinfo &si, int tos)
245	{	490	{
246	if (revents & (POLLIN \| POLLERR))	491	switch (si.prot)
		492	{
		493	case PROT_IPv4:
		494	return send_ipv4_packet (pkt, si, tos);
		495
		496	case PROT_UDPv4:
		497	return send_udpv4_packet (pkt, si, tos);
		498
		499	#if ENABLE_TCP
		500	case PROT_TCPv4:
		501	return send_tcpv4_packet (pkt, si, tos);
		502	#endif
		503	#if ENABLE_ICMP
		504	case PROT_ICMPv4:
		505	return send_icmpv4_packet (pkt, si, tos);
		506	#endif
		507	#if ENABLE_DNS
		508	case PROT_DNSv4:
		509	return send_dnsv4_packet (pkt, si, tos);
		510	#endif
		511	default:
		512	slog (L_CRIT, _("%s: FATAL: trying to send packet with unsupported protocol"), (const char *)si);
		513	}
		514
		515	return false;
		516	}
		517
		518	inline void
		519	vpn::ipv4_ev (ev::io &w, int revents)
		520	{
		521	if (revents & EV_READ)
247	{	522	{
248	vpn_packet *pkt = new vpn_packet;	523	vpn_packet *pkt = new vpn_packet;
249	struct sockaddr_in sa;	524	struct sockaddr_in sa;
250	socklen_t sa_len = sizeof (sa);	525	socklen_t sa_len = sizeof (sa);
251	int len;	526	int len;
252		527
253	len = recvfrom (w.fd, &((pkt)[0]), MAXSIZE, 0, (sockaddr )&sa, &sa_len);	528	len = recvfrom (w.fd, &((pkt)[0]), MAXSIZE, 0, (sockaddr )&sa, &sa_len);
254		529
255	sockinfo si(sa);	530	sockinfo si(sa, PROT_IPv4);
256		531
257	if (len > 0)	532	if (len > 0)
258	{	533	{
259	pkt->len = len;	534	pkt->len = len;
		535
		536	// raw sockets deliver the ipv4 header, but don't expect it on sends
		537	pkt->skip_hdr (IP_OVERHEAD);
260		538
261	recv_vpn_packet (pkt, si);	539	recv_vpn_packet (pkt, si);
262	}	540	}
263	else	541	else
264	{	542	{
…		…
266	slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));	544	slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));
267	}	545	}
268		546
269	delete pkt;	547	delete pkt;
270	}	548	}
271	else if (revents & POLLHUP)
272	{
273	// this cannot ;) happen on udp sockets
274	slog (L_ERR, _("FATAL: POLLHUP on udp v4 fd, terminating."));
275	exit (1);
276	}
277	else	549	else
278	{	550	{
279	slog (L_ERR,	551	slog (L_ERR,
280	_("FATAL: unknown revents %08x in socket, terminating\n"),	552	_("FATAL: unknown revents %08x in socket, terminating\n"),
281	revents);	553	revents);
282	exit (1);	554	exit (EXIT_FAILURE);
283	}	555	}
284	}	556	}
285		557
286	void	558	#if ENABLE_ICMP
		559	inline void
287	vpn::ipv4_ev (io_watcher &w, short revents)	560	vpn::icmpv4_ev (ev::io &w, int revents)
288	{	561	{
289	if (revents & (POLLIN \| POLLERR))	562	if (revents & EV_READ)
290	{	563	{
291	vpn_packet *pkt = new vpn_packet;	564	vpn_packet *pkt = new vpn_packet;
292	struct sockaddr_in sa;	565	struct sockaddr_in sa;
293	socklen_t sa_len = sizeof (sa);	566	socklen_t sa_len = sizeof (sa);
294	int len;	567	int len;
295		568
296	len = recvfrom (w.fd, &((pkt)[0]), MAXSIZE, 0, (sockaddr )&sa, &sa_len);	569	len = recvfrom (w.fd, &((pkt)[0]), MAXSIZE, 0, (sockaddr )&sa, &sa_len);
297		570
298	sockinfo si(sa, PROT_IPv4);	571	sockinfo si(sa, PROT_ICMPv4);
299		572
300	if (len > 0)	573	if (len > 0)
301	{	574	{
302	pkt->len = len;	575	pkt->len = len;
303		576
		577	icmp_header hdr = (icmp_header )&((*pkt)[IP_OVERHEAD]);
		578
		579	if (hdr->type == ::conf.icmp_type
		580	&& hdr->code == 255)
		581	{
304	// raw sockets deliver the ipv4, but don't expect it on sends	582	// raw sockets deliver the ipv4, but don't expect it on sends
305	// this is slow, but...	583	// this is slow, but...
306	pkt->skip_hdr (IP_OVERHEAD);	584	pkt->skip_hdr (ICMP_OVERHEAD);
307		585
308	recv_vpn_packet (pkt, si);	586	recv_vpn_packet (pkt, si);
		587	}
309	}	588	}
310	else	589	else
311	{	590	{
312	// probably ECONNRESET or somesuch	591	// probably ECONNRESET or somesuch
313	slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));	592	slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));
314	}	593	}
315		594
316	delete pkt;	595	delete pkt;
317	}
318	else if (revents & POLLHUP)
319	{
320	// this cannot ;) happen on udp sockets
321	slog (L_ERR, _("FATAL: POLLHUP on ipv4 fd, terminating."));
322	exit (1);
323	}	596	}
324	else	597	else
325	{	598	{
326	slog (L_ERR,	599	slog (L_ERR,
327	_("FATAL: unknown revents %08x in socket, terminating\n"),	600	_("FATAL: unknown revents %08x in socket, terminating\n"),
328	revents);	601	revents);
329	exit (1);	602	exit (EXIT_FAILURE);
330	}
331	}
332
333	#if ENABLE_TCP
334
335	struct tcp_connection;
336
337	struct lt_sockinfo
338	{
339	bool operator()(const sockinfo a, const sockinfo b) const
340	{
341	return a < b;
342	}
343	};
344
345	struct tcp_si_map : public map<const sockinfo , tcp_connection , lt_sockinfo> {
346	void cleaner_cb (time_watcher &w); time_watcher cleaner;
347
348	tcp_si_map ()
349	: cleaner(this, &tcp_si_map::cleaner_cb)
350	{
351	cleaner.start (0);
352	}
353	} tcp_si;
354
355	struct tcp_connection : io_watcher {
356	tstamp last_activity;
357	const sockinfo si;
358	vpn &v;
359	bool ok;
360
361	void tcpv4_ev (io_watcher &w, short revents);
362
363	operator tcp_si_map::value_type()
364	{
365	return tcp_si_map::value_type (&si, this);
366	}
367
368	tcp_connection (int fd_, const sockinfo &si_, vpn &v_)
369	: v(v_), si(si_), io_watcher(this, &tcp_connection::tcpv4_ev), ok(false)
370	{
371	last_activity = NOW;
372	start (fd_, POLLOUT);
373	}
374
375	~tcp_connection () { close (fd); }
376	};
377
378	void tcp_si_map::cleaner_cb (time_watcher &w)
379	{
380	w.at = NOW + 600;
381	tstamp to = NOW - ::conf.keepalive - 30;
382
383	for (iterator i = begin (); i != end(); )
384	if (i->second->last_activity >= to)
385	++i;
386	else
387	{
388	erase (i);
389	i = begin ();
390	}	603	}
391	}	604	}
		605	#endif
392		606
393	void	607	inline void
394	vpn::send_tcpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)	608	vpn::udpv4_ev (ev::io &w, int revents)
395	{	609	{
396	tcp_si_map::iterator info = tcp_si.find (&si);	610	if (revents & EV_READ)
397
398	if (info == tcp_si.end ())
399	{
400	// woaw, the first lost packet ;)
401	int fd = socket (PF_INET, SOCK_STREAM, IPPROTO_TCP);
402
403	if (fd >= 0)
404	{
405	fcntl (fd, F_SETFL, O_NONBLOCK);
406
407	if (connect (fd, si.sav4 (), si.salenv4 ()) >= 0
408	\|\| errno == EINPROGRESS)
409	{
410	tcp_connection i = new tcp_connection (fd, si, this);
411
412	tcp_si.insert (*i);
413	}
414	else
415	close (fd);
416	}
417	}	611	{
418	else
419	{
420	tcp_connection *i = info->second;
421
422	i->last_activity = NOW;
423
424	if (i->ok)
425	{
426	setsockopt (i->fd, SOL_IP, IP_TOS, &tos, sizeof tos);
427
428	// we use none of the advantages of tcp
429	write (i->fd, (void *)pkt, pkt->len + sizeof (u32)) != pkt->len + sizeof (u32);
430	}
431	}
432
433	#if 0
434	setsockopt (udpv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
435	sendto (udpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
436	#endif
437	}
438
439	void
440	tcp_connection::tcpv4_ev (io_watcher &w, short revents)
441	{
442	last_activity = NOW;
443
444	if (!ok) // just established?
445	{
446	ok = true;
447	fcntl (fd, F_SETFL, 0);
448	stop ();
449	start (fd, POLLIN);
450	}
451
452	if (revents & (POLLIN \| POLLERR))
453	{
454	u32 len;
455
456	if (sizeof (len) == read (fd, &len, sizeof (len)))
457	{
458	vpn_packet *pkt = new vpn_packet;	612	vpn_packet *pkt = new vpn_packet;
459
460	if (len == read (fd, &((*pkt)[0]), len))
461	{
462	pkt->len = len;
463
464	v.recv_vpn_packet (pkt, si);
465	return;
466	}
467
468	delete pkt;
469	}
470
471	tcp_si.erase (&si);
472	stop ();
473	}
474	}
475
476	void
477	vpn::tcpv4_ev (io_watcher &w, short revents)
478	{
479	if (revents & (POLLIN \| POLLERR))
480	{
481	struct sockaddr_in sa;	613	struct sockaddr_in sa;
482	socklen_t sa_len = sizeof (sa);	614	socklen_t sa_len = sizeof (sa);
483	int len;	615	int len;
484		616
485	int fd = accept (w.fd, (sockaddr *)&sa, &sa_len);	617	len = recvfrom (w.fd, &((pkt)[0]), MAXSIZE, 0, (sockaddr )&sa, &sa_len);
486		618
487	if (fd >= 0)
488	{
489	fcntl (fd, F_SETFL, O_NONBLOCK);
490
491	sockinfo si(sa, PROT_TCPv4);	619	sockinfo si(sa, PROT_UDPv4);
492	tcp_connection i = new tcp_connection (fd, si, this);
493		620
494	slog (L_ERR, "accepted %d\n", fd);//D	621	if (len > 0)
495
496	tcp_si.insert (*i);
497	}	622	{
		623	pkt->len = len;
		624
		625	recv_vpn_packet (pkt, si);
		626	}
		627	else
		628	{
		629	// probably ECONNRESET or somesuch
		630	slog (L_DEBUG, _("%s: fd %d, %s"), (const char *)si, w.fd, strerror (errno));
		631	}
		632
		633	delete pkt;
		634	}
		635	else
498	}	636	{
		637	slog (L_ERR,
		638	_("FATAL: unknown revents %08x in socket, terminating\n"),
		639	revents);
		640	exit (EXIT_FAILURE);
		641	}
499	}	642	}
500		643
501	#endif	644	inline void
502
503	void
504	vpn::tap_ev (io_watcher &w, short revents)	645	vpn::tap_ev (ev::io &w, int revents)
505	{	646	{
506	if (revents & POLLIN)	647	if (revents & EV_READ)
507	{	648	{
508	/* process data */	649	/* process data */
509	tap_packet *pkt;	650	tap_packet *pkt;
510		651
511	pkt = tap->recv ();	652	pkt = tap->recv ();
512		653
		654	if (!pkt)
		655	return;
		656
		657	if (pkt->len > 14)
		658	{
513	int dst = mac2id (pkt->dst);	659	int dst = mac2id (pkt->dst);
514	int src = mac2id (pkt->src);	660	int src = mac2id (pkt->src);
515		661
516	if (src != THISNODE->id)	662	if (src != THISNODE->id)
517	{
518	slog (L_ERR, _("FATAL: tap packet not originating on current node received, terminating."));
519	exit (1);
520	}
521
522	if (dst == THISNODE->id)
523	{
524	slog (L_ERR, _("FATAL: tap packet destined for current node received, terminating."));
525	exit (1);
526	}
527
528	if (dst > conns.size ())
529	slog (L_ERR, _("tap packet for unknown node %d received, ignoring."), dst);
530	else
531	{
532	if (dst)
533	{	663	{
534	// unicast	664	slog (L_ERR, _("FATAL: tap packet not originating on current node received (if-up script not working properly?), exiting."));
535	if (dst != THISNODE->id)	665	exit (EXIT_FAILURE);
536	conns[dst - 1]->inject_data_packet (pkt);
537	}	666	}
		667
		668	if (dst == THISNODE->id)
		669	{
		670	slog (L_ERR, _("FATAL: tap packet destined for current node received, exiting."));
		671	exit (EXIT_FAILURE);
		672	}
		673
		674	if (dst > conns.size ())
		675	slog (L_ERR, _("tap packet for unknown node %d received, ignoring."), dst);
538	else	676	else
539	{
540	// broadcast, first check router, then self, then english
541	connection *router = find_router ();
542
543	if (router)
544	router->inject_data_packet (pkt, true);	677	inject_data_packet (pkt, dst);
545	else
546	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
547	if ((*c)->conf != THISNODE)
548	(*c)->inject_data_packet (pkt);
549	}
550	}	678	}
551		679
552	delete pkt;	680	delete pkt;
553	}
554	else if (revents & (POLLHUP \| POLLERR))
555	{
556	slog (L_ERR, _("FATAL: POLLHUP or POLLERR on network device fd, terminating."));
557	exit (1);
558	}	681	}
559	else	682	else
560	abort ();	683	abort ();
561	}	684	}
562		685
563	void	686	inline void
564	vpn::event_cb (time_watcher &w)	687	vpn::event_cb (ev::timer &w, int)
565	{	688	{
566	if (events)	689	if (events)
567	{	690	{
568	if (events & EVENT_SHUTDOWN)	691	if (events & EVENT_SHUTDOWN)
569	{	692	{
570	slog (L_INFO, _("preparing shutdown..."));	693	slog (L_INFO, _("preparing shutdown..."));
571		694
572	shutdown_all ();	695	shutdown_all ();
573
574	remove_pid (pidfilename);	696	remove_pid (conf.pidfilename);
575
576	slog (L_INFO, _("terminating"));	697	slog (L_INFO, _("terminating"));
577		698	exit (EXIT_SUCCESS);
578	exit (0);
579	}	699	}
580		700
581	if (events & EVENT_RECONNECT)	701	if (events & EVENT_RECONNECT)
582	{	702	{
583	slog (L_INFO, _("forced reconnect"));	703	slog (L_INFO, _("forced reconnect"));
…		…
585	reconnect_all ();	705	reconnect_all ();
586	}	706	}
587		707
588	events = 0;	708	events = 0;
589	}	709	}
590
591	w.at = TSTAMP_CANCEL;
592	}	710	}
593		711
594	void	712	void
595	vpn::shutdown_all ()	713	vpn::shutdown_all ()
596	{	714	{
…		…
609	connection_init ();	727	connection_init ();
610		728
611	for (configuration::node_vector::iterator i = conf.nodes.begin ();	729	for (configuration::node_vector::iterator i = conf.nodes.begin ();
612	i != conf.nodes.end (); ++i)	730	i != conf.nodes.end (); ++i)
613	{	731	{
614	connection *conn = new connection (this);	732	connection conn = new connection (this, i);
615
616	conn->conf = *i;
617	conns.push_back (conn);	733	conns.push_back (conn);
618
619	conn->establish_connection ();	734	conn->establish_connection ();
620	}	735	}
621	}	736	}
622		737
623	connection *vpn::find_router ()	738	connection *vpn::find_router ()
624	{	739	{
625	u32 prio = 0;	740	u32 prio = 1;
626	connection *router = 0;	741	connection *router = 0;
627		742
628	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)	743	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
629	{	744	{
630	connection c = i;	745	connection c = i;
631		746
632	if (c->conf->routerprio > prio	747	if (c->conf->routerprio > prio
633	&& c->connectmode == conf_node::C_ALWAYS	748	&& c->connectmode == conf_node::C_ALWAYS // so we don't drop the connection if in use
634	&& c->conf != THISNODE
635	&& c->ictx && c->octx)	749	&& c->ictx && c->octx
		750	&& c->conf != THISNODE) // redundant, since ictx==octx==0 always on thisnode
636	{	751	{
637	prio = c->conf->routerprio;	752	prio = c->conf->routerprio;
638	router = c;	753	router = c;
639	}	754	}
640	}	755	}
641		756
642	return router;	757	return router;
643	}	758	}
644		759
645	void vpn::connect_request (int id)	760	void vpn::send_connect_request (int id)
646	{	761	{
647	connection *c = find_router ();	762	connection *c = find_router ();
648		763
649	if (c)	764	if (c)
650	c->connect_request (id);	765	c->send_connect_request (id);
651	//else // does not work, because all others must connect to the same router	766	else
652	// // no router found, aggressively connect to all routers	767	// no router found, aggressively connect to all routers
653	// for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)	768	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
654	// if ((*i)->conf->routerprio)	769	if ((i)->conf->routerprio && (i)->conf != THISNODE)
655	// (*i)->establish_connection ();	770	(*i)->establish_connection ();
656	}	771	}
657		772
658	void	773	void
659	connection::dump_status ()	774	connection::dump_status ()
660	{	775	{
…		…
668	}	783	}
669		784
670	void	785	void
671	vpn::dump_status ()	786	vpn::dump_status ()
672	{	787	{
673	slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)NOW);	788	slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)ev_now ());
674		789
675	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)	790	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
676	(*c)->dump_status ();	791	(*c)->dump_status ();
677		792
678	slog (L_NOTICE, _("END status dump"));	793	slog (L_NOTICE, _("END status dump"));
679	}	794	}
680		795
681	vpn::vpn (void)	796	vpn::vpn (void)
682	: event(this, &vpn::event_cb)	797	{
		798	event .set<vpn, &vpn::event_cb > (this);
683	, udpv4_ev_watcher(this, &vpn::udpv4_ev)	799	udpv4_ev_watcher .set<vpn, &vpn::udpv4_ev > (this);
684	, ipv4_ev_watcher (this, &vpn::ipv4_ev)	800	ipv4_ev_watcher .set<vpn, &vpn::ipv4_ev > (this);
685	, tap_ev_watcher (this, &vpn::tap_ev)
686	#if ENABLE_TCP	801	#if ENABLE_TCP
687	, tcpv4_ev_watcher(this, &vpn::tcpv4_ev)	802	tcpv4_ev_watcher .set<vpn, &vpn::tcpv4_ev > (this);
688	#endif	803	#endif
689	{	804	#if ENABLE_ICMP
		805	icmpv4_ev_watcher.set<vpn, &vpn::icmpv4_ev> (this);
		806	#endif
		807	#if ENABLE_DNS
		808	dnsv4_ev_watcher .set<vpn, &vpn::dnsv4_ev > (this);
		809	#endif
		810	tap_ev_watcher .set<vpn, &vpn::tap_ev > (this);
690	}	811	}
691		812
692	vpn::~vpn ()	813	vpn::~vpn ()
693	{	814	{
694	}	815	}

Diff Legend

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

Comparing gvpe/src/vpn.C (file contents): Revision 1.3 by pcg, Wed Apr 2 21:02:25 2003 UTC vs. Revision 1.47 by pcg, Thu Aug 7 17:54:27 2008 UTC

Diff Legend

Comparing gvpe/src/vpn.C (file contents):
Revision 1.3 by pcg, Wed Apr 2 21:02:25 2003 UTC vs.
Revision 1.47 by pcg, Thu Aug 7 17:54:27 2008 UTC