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

Comparing gvpe/src/vpn.C (file contents):
Revision 1.2 by pcg, Wed Apr 2 05:15:00 2003 UTC vs.
Revision 1.48 by pcg, Sat Aug 9 18:30:55 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;
91		170
92	sockinfo si (THISNODE, PROT_UDPv4);	171	fcntl (udpv4_fd, F_SETFL, O_NONBLOCK);
		172	fcntl (udpv4_fd, F_SETFD, FD_CLOEXEC);
93		173
94	if (bind (udpv4_fd, si.sav4 (), si.salenv4 ()))	174	// standard daemon practise...
95	{	175	{
96	slog (L_ERR, _("can't bind udpv4 on %s: %s"), (const char *)si, strerror (errno));	176	int oval = 1;
97	exit (1);	177	setsockopt (udpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
98	}	178	}
99		179
100	#ifdef IP_MTU_DISCOVER	180	#if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
101	// this I really consider a linux bug. I am neither connected	181	// this I really consider a linux bug. I am neither connected
102	// 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
103	// fragment for me sometimes.	183	// fragment for me sometimes.
104	{	184	{
105	int oval = IP_PMTUDISC_DONT;	185	int oval = IP_PMTUDISC_DONT;
106	setsockopt (udpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);	186	setsockopt (udpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
107	}	187	}
108	#endif	188	#endif
109		189
110	// standard daemon practise...	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
		198	udpv4_ev_watcher.start (udpv4_fd, EV_READ);
		199	}
		200
		201	icmpv4_tos = -1;
		202	icmpv4_fd = -1;
		203
		204	#if ENABLE_ICMP
		205	if (THISNODE->protocols & PROT_ICMPv4)
		206	{
		207	icmpv4_fd = socket (PF_INET, SOCK_RAW, IPPROTO_ICMP);
		208
		209	if (icmpv4_fd < 0)
		210	return -1;
		211
		212	fcntl (icmpv4_fd, F_SETFL, O_NONBLOCK);
		213	fcntl (icmpv4_fd, F_SETFD, FD_CLOEXEC);
		214
		215	#ifdef ICMP_FILTER
111	{	216	{
112	int oval = 1;	217	icmp_filter oval;
		218	oval.data = 0xffffffff;
		219	if (::conf.icmp_type < 32)
		220	oval.data &= ~(1 << ::conf.icmp_type);
		221
113	setsockopt (udpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);	222	setsockopt (icmpv4_fd, SOL_RAW, ICMP_FILTER, &oval, sizeof oval);
114	}	223	}
		224	#endif
115		225
116	udpv4_ev_watcher.start (udpv4_fd, POLLIN);	226	#if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
117	}
118
119	ipv4_fd = -1;
120	if (THISNODE->protocols & PROT_IPv4)
121	{
122	ipv4_fd = socket (PF_INET, SOCK_RAW, ::conf.ip_proto);
123
124	if (ipv4_fd < 0)
125	return -1;
126
127	sockinfo si (THISNODE, PROT_IPv4);
128
129	if (bind (ipv4_fd, si.sav4 (), si.salenv4 ()))
130	{
131	slog (L_ERR, _("can't bind ipv4 socket on %s: %s"), (const char *)si, strerror (errno));
132	exit (1);
133	}
134
135	#ifdef 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;
155		257
156	sockinfo si (THISNODE, PROT_TCPv4);	258	fcntl (tcpv4_fd, F_SETFL, O_NONBLOCK);
157		259	fcntl (tcpv4_fd, F_SETFD, FD_CLOEXEC);
158	if (bind (tcpv4_fd, si.sav4 (), si.salenv4 ()))
159	{
160	slog (L_ERR, _("can't bind tcpv4 on %s: %s"), (const char *)si, strerror (errno));
161	exit (1);
162	}
163
164	if (listen (tcpv4_fd, 5))
165	{
166	slog (L_ERR, _("can't listen tcpv4 on %s: %s"), (const char *)si, strerror (errno));
167	exit (1);
168	}
169		260
170	// standard daemon practise...	261	// standard daemon practise...
171	{	262	{
172	int oval = 1;	263	int oval = 1;
173	setsockopt (tcpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);	264	setsockopt (tcpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
174	}	265	}
175		266
		267	sockinfo si (THISNODE, PROT_TCPv4);
		268
		269	if (bind (tcpv4_fd, si.sav4 (), si.salenv4 ()))
		270	{
		271	slog (L_ERR, _("can't bind tcpv4 on %s: %s"), (const char *)si, strerror (errno));
		272	exit (EXIT_FAILURE);
		273	}
		274
		275	if (listen (tcpv4_fd, 5))
		276	{
		277	slog (L_ERR, _("can't listen tcpv4 on %s: %s"), (const char *)si, strerror (errno));
		278	exit (EXIT_FAILURE);
		279	}
		280
176	tcpv4_accept_watcher.start (tcpv4_fd, POLLIN);	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);
177	}	308	}
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 (int fd, 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 (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
287	vpn::ipv4_ev (int fd, short revents)	559	inline void
		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 (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_info {
336	int fd;
337	bool ok;
338	io_watcher r;
339
340	tcp_info (vpn *v)
341	: r(v, &vpn::tcpv4_ev)
342	{	603	}
343	fd = -1;	604	}
		605	#endif
		606
		607	inline void
		608	vpn::udpv4_ev (ev::io &w, int revents)
		609	{
		610	if (revents & EV_READ)
344	}	611	{
345		612	vpn_packet *pkt = new vpn_packet;
346	~tcp_info () { close (fd); }
347	};
348
349	typedef map<sockinfo, tcp_info *> tcp_si_map;
350	typedef map<int, tcp_info *> tcp_fd_map; // unneecssary if iom would be cooler
351	static tcp_si_map tcp_si;
352	static tcp_fd_map tcp_fd;
353
354	void
355	vpn::send_tcpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
356	{
357	tcp_si_map::iterator info = tcp_si.find (si);
358
359	if (info == tcp_si.end ())
360	{
361	// woaw, the first lost packet ;)
362	tcp_info *i = new tcp_info (this);
363
364	i->ok = false;
365	i->fd = socket (PF_INET, SOCK_STREAM, IPPROTO_TCP);
366
367	if (i->fd >= 0)
368	{
369	fcntl (i->fd, F_SETFL, O_NONBLOCK);
370
371	if (connect (i->fd, si.sav4 (), si.salenv4 ()) >= 0
372	\|\| errno == EINPROGRESS)
373	{
374	tcp_si.insert (tcp_si_map::value_type (si, i));
375	tcp_fd.insert (tcp_fd_map::value_type (i->fd, i));
376	return;
377	}
378
379	delete i;
380	}
381	}
382	else
383	{
384	tcp_info *i = info->second;
385
386	if (i->ok)
387	{
388	setsockopt (i->fd, SOL_IP, IP_TOS, &tos, sizeof tos);
389
390	if (write (i->fd, (void *)pkt, pkt->len + sizeof (u32)) != pkt->len + sizeof (u32))
391	{
392	// error, close socket, forget it and retry immediately
393	tcp_si.erase (info);
394	tcp_fd.erase (i->fd);
395	delete i;
396
397	// tail recursion is... better than goto(?)
398	send_tcpv4_packet (pkt, si, tos);
399	}
400	}
401	}
402
403	#if 0
404	setsockopt (udpv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
405	sendto (udpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
406	#endif
407	}
408
409	void
410	vpn::tcpv4_accept (int fd, short revents)
411	{
412	if (revents & (POLLIN \| POLLERR))
413	{
414	struct sockaddr_in sa;	613	struct sockaddr_in sa;
415	socklen_t sa_len = sizeof (sa);	614	socklen_t sa_len = sizeof (sa);
416	int len;	615	int len;
417		616
418	fd = accept (fd, (sockaddr *)&sa, &sa_len);	617	len = recvfrom (w.fd, &((pkt)[0]), MAXSIZE, 0, (sockaddr )&sa, &sa_len);
419		618
420	if (fd >= 0)
421	{
422	fcntl (fd, F_SETFL, O_NONBLOCK);
423
424	sockinfo si(sa, PROT_TCPv4);	619	sockinfo si(sa, PROT_UDPv4);
425	tcp_info *i = new tcp_info (this);
426		620
427	i->fd = fd;	621	if (len > 0)
428	i->ok = true;
429	i->r.start (fd, POLLIN);
430
431	tcp_si.insert (tcp_si_map::value_type (si, i));
432	tcp_fd.insert (tcp_fd_map::value_type (fd, i));
433	}	622	{
434	}	623	pkt->len = len;
435	}
436		624
437	void	625	recv_vpn_packet (pkt, si);
438	vpn::tcpv4_ev (int fd, short revents)
439	{
440	if (revents & (POLLIN \| POLLERR))
441	{
442	tcp_fd_map::iterator info = tcp_fd.find (fd);
443
444	if (info != tcp_fd.end ())
445	{	626	}
446	tcp_info *i = info->second;	627	else
447
448	if (!i->ok) // not yet established
449	{
450	i->ok = true;
451	fcntl (i->fd, F_SETFL, 0);
452	}
453
454	u32 len;
455
456	if (sizeof (len) == read (fd, &len, sizeof (len)))
457	{
458	slog (L_ERR, "%d bytes received\n", len);
459	}
460
461	//tcp_si.erase (i);
462	tcp_fd.erase (fd);
463	delete i;
464	}	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
465	}	636	{
		637	slog (L_ERR,
		638	_("FATAL: unknown revents %08x in socket, terminating\n"),
		639	revents);
		640	exit (EXIT_FAILURE);
		641	}
466	}	642	}
467		643
468	#endif	644	inline void
469		645	vpn::tap_ev (ev::io &w, int revents)
470	void
471	vpn::tap_ev (int fd, short revents)
472	{	646	{
473	if (revents & POLLIN)	647	if (revents & EV_READ)
474	{	648	{
475	/* process data */	649	/* process data */
476	tap_packet *pkt;	650	tap_packet *pkt;
477		651
478	pkt = tap->recv ();	652	pkt = tap->recv ();
479		653
		654	if (!pkt)
		655	return;
		656
		657	if (pkt->len > 14)
		658	{
480	int dst = mac2id (pkt->dst);	659	int dst = mac2id (pkt->dst);
481	int src = mac2id (pkt->src);	660	int src = mac2id (pkt->src);
482		661
483	if (src != THISNODE->id)	662	if (src != THISNODE->id)
484	{
485	slog (L_ERR, _("FATAL: tap packet not originating on current node received, terminating."));
486	exit (1);
487	}
488
489	if (dst == THISNODE->id)
490	{
491	slog (L_ERR, _("FATAL: tap packet destined for current node received, terminating."));
492	exit (1);
493	}
494
495	if (dst > conns.size ())
496	slog (L_ERR, _("tap packet for unknown node %d received, ignoring."), dst);
497	else
498	{
499	if (dst)
500	{	663	{
501	// unicast	664	slog (L_ERR, _("FATAL: tap packet not originating on current node received (if-up script not working properly?), exiting."));
502	if (dst != THISNODE->id)	665	exit (EXIT_FAILURE);
503	conns[dst - 1]->inject_data_packet (pkt);
504	}	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);
505	else	676	else
506	{
507	// broadcast, first check router, then self, then english
508	connection *router = find_router ();
509
510	if (router)
511	router->inject_data_packet (pkt, true);	677	inject_data_packet (pkt, dst);
512	else
513	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
514	if ((*c)->conf != THISNODE)
515	(*c)->inject_data_packet (pkt);
516	}
517	}	678	}
518		679
519	delete pkt;	680	delete pkt;
520	}
521	else if (revents & (POLLHUP \| POLLERR))
522	{
523	slog (L_ERR, _("FATAL: POLLHUP or POLLERR on network device fd, terminating."));
524	exit (1);
525	}	681	}
526	else	682	else
527	abort ();	683	abort ();
528	}	684	}
529		685
530	void	686	inline void
531	vpn::event_cb (tstamp &ts)	687	vpn::event_cb (ev::timer &w, int)
532	{	688	{
533	if (events)	689	if (events)
534	{	690	{
535	if (events & EVENT_SHUTDOWN)	691	if (events & EVENT_SHUTDOWN)
536	{	692	{
537	slog (L_INFO, _("preparing shutdown..."));	693	slog (L_INFO, _("preparing shutdown..."));
538		694
539	shutdown_all ();	695	shutdown_all ();
540
541	remove_pid (pidfilename);	696	remove_pid (conf.pidfilename);
542
543	slog (L_INFO, _("terminating"));	697	slog (L_INFO, _("terminating"));
544		698	exit (EXIT_SUCCESS);
545	exit (0);
546	}	699	}
547		700
548	if (events & EVENT_RECONNECT)	701	if (events & EVENT_RECONNECT)
549	{	702	{
550	slog (L_INFO, _("forced reconnect"));	703	slog (L_INFO, _("forced reconnect"));
…		…
552	reconnect_all ();	705	reconnect_all ();
553	}	706	}
554		707
555	events = 0;	708	events = 0;
556	}	709	}
557
558	ts = TSTAMP_CANCEL;
559	}	710	}
560		711
561	void	712	void
562	vpn::shutdown_all ()	713	vpn::shutdown_all ()
563	{	714	{
…		…
576	connection_init ();	727	connection_init ();
577		728
578	for (configuration::node_vector::iterator i = conf.nodes.begin ();	729	for (configuration::node_vector::iterator i = conf.nodes.begin ();
579	i != conf.nodes.end (); ++i)	730	i != conf.nodes.end (); ++i)
580	{	731	{
581	connection *conn = new connection (this);	732	connection conn = new connection (this, i);
582
583	conn->conf = *i;
584	conns.push_back (conn);	733	conns.push_back (conn);
585
586	conn->establish_connection ();	734	conn->establish_connection ();
587	}	735	}
588	}	736	}
589		737
590	connection *vpn::find_router ()	738	connection *vpn::find_router ()
591	{	739	{
592	u32 prio = 0;	740	u32 prio = 1;
593	connection *router = 0;	741	connection *router = 0;
594		742
595	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)	743	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
596	{	744	{
597	connection c = i;	745	connection c = i;
598		746
599	if (c->conf->routerprio > prio	747	if (c->conf->routerprio > prio
600	&& c->connectmode == conf_node::C_ALWAYS	748	&& c->connectmode == conf_node::C_ALWAYS // so we don't drop the connection if in use
601	&& c->conf != THISNODE
602	&& c->ictx && c->octx)	749	&& c->ictx && c->octx
		750	&& c->conf != THISNODE) // redundant, since ictx==octx==0 always on thisnode
603	{	751	{
604	prio = c->conf->routerprio;	752	prio = c->conf->routerprio;
605	router = c;	753	router = c;
606	}	754	}
607	}	755	}
608		756
609	return router;	757	return router;
610	}	758	}
611		759
612	void vpn::connect_request (int id)	760	void vpn::send_connect_request (int id)
613	{	761	{
614	connection *c = find_router ();	762	connection *c = find_router ();
615		763
616	if (c)	764	if (c)
617	c->connect_request (id);	765	c->send_connect_request (id);
618	//else // does not work, because all others must connect to the same router	766	else
619	// // no router found, aggressively connect to all routers	767	// no router found, aggressively connect to all routers
620	// for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)	768	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
621	// if ((*i)->conf->routerprio)	769	if ((i)->conf->routerprio && (i)->conf != THISNODE)
622	// (*i)->establish_connection ();	770	(*i)->establish_connection ();
623	}	771	}
624		772
625	void	773	void
626	connection::dump_status ()	774	connection::dump_status ()
627	{	775	{
628	slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);	776	slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);
629	slog (L_NOTICE, _(" connectmode %d (%d) / sockaddr %s / minor %d"),	777	slog (L_NOTICE, _(" connectmode %d (%d) / sockaddr %s / minor %d"),
630	connectmode, conf->connectmode, (const char *)si, (int)prot_minor);	778	connectmode, conf->connectmode, (const char *)si, (int)prot_minor);
631	slog (L_NOTICE, _(" ictx/octx %08lx/%08lx / oseqno %d / retry_cnt %d"),	779	slog (L_NOTICE, _(" ictx/octx %08lx/%08lx / oseqno %d / retry_cnt %d"),
632	(long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);	780	(long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);
633	slog (L_NOTICE, _(" establish_conn %ld / rekey %ld / keepalive %ld"),
634	(long)(establish_connection.at), (long)(rekey.at), (long)(keepalive.at));
635	}	781	}
636		782
637	void	783	void
638	vpn::dump_status ()	784	vpn::dump_status ()
639	{	785	{
640	slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)NOW);	786	slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)ev_now ());
641		787
642	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)	788	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
643	(*c)->dump_status ();	789	(*c)->dump_status ();
644		790
645	slog (L_NOTICE, _("END status dump"));	791	slog (L_NOTICE, _("END status dump"));
646	}	792	}
647		793
648	vpn::vpn (void)	794	vpn::vpn (void)
649	: event(this, &vpn::event_cb)	795	{
		796	event .set<vpn, &vpn::event_cb > (this);
650	, udpv4_ev_watcher(this, &vpn::udpv4_ev)	797	udpv4_ev_watcher .set<vpn, &vpn::udpv4_ev > (this);
651	, ipv4_ev_watcher (this, &vpn::ipv4_ev)	798	ipv4_ev_watcher .set<vpn, &vpn::ipv4_ev > (this);
652	, tap_ev_watcher (this, &vpn::tap_ev)
653	#if ENABLE_TCP	799	#if ENABLE_TCP
654	, tcpv4_accept_watcher(this, &vpn::tcpv4_accept)	800	tcpv4_ev_watcher .set<vpn, &vpn::tcpv4_ev > (this);
655	#endif	801	#endif
656	{	802	#if ENABLE_ICMP
		803	icmpv4_ev_watcher.set<vpn, &vpn::icmpv4_ev> (this);
		804	#endif
		805	#if ENABLE_DNS
		806	dnsv4_ev_watcher .set<vpn, &vpn::dnsv4_ev > (this);
		807	#endif
		808	tap_ev_watcher .set<vpn, &vpn::tap_ev > (this);
657	}	809	}
658		810
659	vpn::~vpn ()	811	vpn::~vpn ()
660	{	812	{
661	}	813	}

Diff Legend

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

Comparing gvpe/src/vpn.C (file contents): Revision 1.2 by pcg, Wed Apr 2 05:15:00 2003 UTC vs. Revision 1.48 by pcg, Sat Aug 9 18:30:55 2008 UTC

Diff Legend

Comparing gvpe/src/vpn.C (file contents):
Revision 1.2 by pcg, Wed Apr 2 05:15:00 2003 UTC vs.
Revision 1.48 by pcg, Sat Aug 9 18:30:55 2008 UTC