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

Comparing gvpe/src/vpn.C (file contents):
Revision 1.7 by pcg, Sun Apr 6 18:12:18 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
		57	vpn network; // THE vpn (bad design...)
		58
43	/////////////////////////////////////////////////////////////////////////////	59	/////////////////////////////////////////////////////////////////////////////
44		60
45	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 ()
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;
71	}	122	}
72		123
73	int	124	int
74	vpn::setup ()	125	vpn::setup ()
75	{	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;
76	udpv4_fd = -1;	162	udpv4_fd = -1;
77		163
78	if (THISNODE->protocols & PROT_UDPv4)	164	if (THISNODE->protocols & PROT_UDPv4 && THISNODE->udp_port)
79	{	165	{
80	udpv4_fd = socket (PF_INET, SOCK_DGRAM, IPPROTO_UDP);	166	udpv4_fd = socket (PF_INET, SOCK_DGRAM, IPPROTO_UDP);
81		167
82	if (udpv4_fd < 0)	168	if (udpv4_fd < 0)
83	return -1;	169	return -1;
		170
		171	fcntl (udpv4_fd, F_SETFL, O_NONBLOCK);
		172	fcntl (udpv4_fd, F_SETFD, FD_CLOEXEC);
84		173
85	// standard daemon practise...	174	// standard daemon practise...
86	{	175	{
87	int oval = 1;	176	int oval = 1;
88	setsockopt (udpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);	177	setsockopt (udpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
89	}	178	}
90		179
91	sockinfo si (THISNODE, PROT_UDPv4);	180	#if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
92
93	if (bind (udpv4_fd, si.sav4 (), si.salenv4 ()))
94	{
95	slog (L_ERR, _("can't bind udpv4 on %s: %s"), (const char *)si, strerror (errno));
96	exit (1);
97	}
98
99	#ifdef IP_MTU_DISCOVER
100	// this I really consider a linux bug. I am neither connected	181	// this I really consider a linux bug. I am neither connected
101	// 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
102	// fragment for me sometimes.	183	// fragment for me sometimes.
103	{	184	{
104	int oval = IP_PMTUDISC_DONT;	185	int oval = IP_PMTUDISC_DONT;
105	setsockopt (udpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);	186	setsockopt (udpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
106	}	187	}
107	#endif	188	#endif
108		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
109	udpv4_ev_watcher.start (udpv4_fd, POLLIN);	198	udpv4_ev_watcher.start (udpv4_fd, EV_READ);
110	}	199	}
111		200
		201	icmpv4_tos = -1;
112	ipv4_fd = -1;	202	icmpv4_fd = -1;
		203
		204	#if ENABLE_ICMP
113	if (THISNODE->protocols & PROT_IPv4)	205	if (THISNODE->protocols & PROT_ICMPv4)
114	{	206	{
115	ipv4_fd = socket (PF_INET, SOCK_RAW, ::conf.ip_proto);	207	icmpv4_fd = socket (PF_INET, SOCK_RAW, IPPROTO_ICMP);
116		208
117	if (ipv4_fd < 0)	209	if (icmpv4_fd < 0)
118	return -1;	210	return -1;
119		211
120	sockinfo si (THISNODE, PROT_IPv4);	212	fcntl (icmpv4_fd, F_SETFL, O_NONBLOCK);
		213	fcntl (icmpv4_fd, F_SETFD, FD_CLOEXEC);
121		214
122	if (bind (ipv4_fd, si.sav4 (), si.salenv4 ()))	215	#ifdef ICMP_FILTER
123	{	216	{
124	slog (L_ERR, _("can't bind ipv4 socket on %s: %s"), (const char *)si, strerror (errno));	217	icmp_filter oval;
125	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);
126	}	223	}
		224	#endif
127		225
128	#ifdef IP_MTU_DISCOVER	226	#if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
129	// this I really consider a linux bug. I am neither connected	227	// this I really consider a linux bug. I am neither connected
130	// 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
131	// fragment for me sometimes.	229	// fragment for me sometimes.
132	{	230	{
133	int oval = IP_PMTUDISC_DONT;	231	int oval = IP_PMTUDISC_DONT;
134	setsockopt (ipv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);	232	setsockopt (icmpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
135	}	233	}
136	#endif	234	#endif
137		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
138	ipv4_ev_watcher.start (ipv4_fd, POLLIN);	244	icmpv4_ev_watcher.start (icmpv4_fd, EV_READ);
139	}	245	}
		246	#endif
		247
		248	tcpv4_fd = -1;
140		249
141	#if ENABLE_TCP	250	#if ENABLE_TCP
142	if (THISNODE->protocols & PROT_TCPv4)	251	if (THISNODE->protocols & PROT_TCPv4 && THISNODE->tcp_port)
143	{	252	{
144	tcpv4_fd = socket (PF_INET, SOCK_STREAM, IPPROTO_TCP);	253	tcpv4_fd = socket (PF_INET, SOCK_STREAM, IPPROTO_TCP);
145		254
146	if (tcpv4_fd < 0)	255	if (tcpv4_fd < 0)
147	return -1;	256	return -1;
		257
		258	fcntl (tcpv4_fd, F_SETFL, O_NONBLOCK);
		259	fcntl (tcpv4_fd, F_SETFD, FD_CLOEXEC);
148		260
149	// standard daemon practise...	261	// standard daemon practise...
150	{	262	{
151	int oval = 1;	263	int oval = 1;
152	setsockopt (tcpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);	264	setsockopt (tcpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
155	sockinfo si (THISNODE, PROT_TCPv4);	267	sockinfo si (THISNODE, PROT_TCPv4);
156		268
157	if (bind (tcpv4_fd, si.sav4 (), si.salenv4 ()))	269	if (bind (tcpv4_fd, si.sav4 (), si.salenv4 ()))
158	{	270	{
159	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));
160	exit (1);	272	exit (EXIT_FAILURE);
161	}	273	}
162		274
163	if (listen (tcpv4_fd, 5))	275	if (listen (tcpv4_fd, 5))
164	{	276	{
165	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));
166	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);
167	}	308	}
168
169	tcpv4_ev_watcher.start (tcpv4_fd, POLLIN);
170	}
171	#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	/////////////////////////////////////////////////////////////////////////////
172		336
173	tap = new tap_device ();	337	tap = new tap_device ();
174	if (!tap) //D this, of course, never catches	338	if (!tap) //D this, of course, never catches
175	{	339	{
176	slog (L_ERR, _("cannot create network interface '%s'"), conf.ifname);	340	slog (L_ERR, _("cannot create network interface '%s'"), conf.ifname);
177	exit (1);	341	exit (EXIT_FAILURE);
178	}	342	}
179		343
180	run_script (run_script_cb (this, &vpn::script_if_up), true);	344	fcntl (tap->fd, F_SETFD, FD_CLOEXEC);
181		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
182	tap_ev_watcher.start (tap->fd, POLLIN);	364	tap_ev_watcher.start (tap->fd, EV_READ);
183
184	reconnect_all ();
185		365
186	return 0;	366	return 0;
187	}
188
189	// send a vpn packet out to other hosts
190	bool
191	vpn::send_vpn_packet (vpn_packet *pkt, const sockinfo &si, int tos)
192	{
193	switch (si.prot)
194	{
195	case PROT_IPv4:
196	return send_ipv4_packet (pkt, si, tos);
197
198	case PROT_UDPv4:
199	return send_udpv4_packet (pkt, si, tos);
200
201	#if ENABLE_TCP
202	case PROT_TCPv4:
203	return send_tcpv4_packet (pkt, si, tos);
204	#endif
205
206	default:
207	slog (L_CRIT, _("%s: FATAL: trying to send packet with unsupported protocol"), (const char *)si);
208	return false;
209	}
210	}	367	}
211		368
212	bool	369	bool
213	vpn::send_ipv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)	370	vpn::send_ipv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
214	{	371	{
215	setsockopt (ipv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);	372	set_tos (ipv4_fd, ipv4_tos, tos);
216	sendto (ipv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());	373	sendto (ipv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
217		374
218	return true;	375	return true;
219	}	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
220		419
221	bool	420	bool
222	vpn::send_udpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)	421	vpn::send_udpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
223	{	422	{
224	setsockopt (udpv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);	423	set_tos (udpv4_fd, udpv4_tos, tos);
225	sendto (udpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());	424	sendto (udpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
226		425
227	return true;	426	return true;
		427	}
		428
		429	void
		430	vpn::inject_data_packet (tap_packet *pkt, int dst)
		431	{
		432	if (dst)
		433	{
		434	// unicast
		435	if (dst != THISNODE->id)
		436	conns[dst - 1]->inject_data_packet (pkt);
		437	}
		438	else
		439	{
		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	}
228	}	446	}
229		447
230	void	448	void
231	vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)	449	vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)
232	{	450	{
…		…
246	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());	464	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
247	else	465	else
248	{	466	{
249	connection *c = conns[src - 1];	467	connection *c = conns[src - 1];
250		468
251	if (dst == 0 && !THISNODE->routerprio)	469	if (dst == 0)
252	slog (L_WARN, _("%s(%s): received broadcast, but we are no router"),	470	slog (L_WARN, _("%s(%s): received broadcast (protocol violation)"),
253	c->conf->nodename, (const char *)rsi);	471	c->conf->nodename, (const char *)rsi);
254	else if (dst != 0 && dst != THISNODE->id)	472	else if (dst != THISNODE->id)
255	{	473	{
256	if (THISNODE->routerprio)	474	if (THISNODE->routerprio)
257	// the tos setting gets lost here. who cares.	475	// the tos setting gets lost here. who cares.
258	conns[dst - 1]->inject_vpn_packet (pkt);	476	conns[dst - 1]->inject_vpn_packet (pkt);
259	else	477	else
…		…
265	else	483	else
266	c->recv_vpn_packet (pkt, rsi);	484	c->recv_vpn_packet (pkt, rsi);
267	}	485	}
268	}	486	}
269		487
270	void	488	bool
271	vpn::udpv4_ev (io_watcher &w, short revents)	489	vpn::send_vpn_packet (vpn_packet *pkt, const sockinfo &si, int tos)
272	{	490	{
273	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)
274	{	522	{
275	vpn_packet *pkt = new vpn_packet;	523	vpn_packet *pkt = new vpn_packet;
276	struct sockaddr_in sa;	524	struct sockaddr_in sa;
277	socklen_t sa_len = sizeof (sa);	525	socklen_t sa_len = sizeof (sa);
278	int len;	526	int len;
279		527
280	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);
281		529
282	sockinfo si(sa, PROT_UDPv4);	530	sockinfo si(sa, PROT_IPv4);
283		531
284	if (len > 0)	532	if (len > 0)
285	{	533	{
286	pkt->len = len;	534	pkt->len = len;
287		535
		536	// raw sockets deliver the ipv4 header, but don't expect it on sends
		537	pkt->skip_hdr (IP_OVERHEAD);
		538
288	recv_vpn_packet (pkt, si);	539	recv_vpn_packet (pkt, si);
289	}	540	}
290	else	541	else
291	{	542	{
292	// probably ECONNRESET or somesuch	543	// probably ECONNRESET or somesuch
293	slog (L_DEBUG, _("%s: fd %d, %s"), (const char *)si, w.fd, strerror (errno));	544	slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));
294	}	545	}
295		546
296	delete pkt;	547	delete pkt;
297	}	548	}
298	else if (revents & POLLHUP)
299	{
300	// this cannot ;) happen on udp sockets
301	slog (L_ERR, _("FATAL: POLLHUP on udp v4 fd, terminating."));
302	exit (1);
303	}
304	else	549	else
305	{	550	{
306	slog (L_ERR,	551	slog (L_ERR,
307	_("FATAL: unknown revents %08x in socket, terminating\n"),	552	_("FATAL: unknown revents %08x in socket, terminating\n"),
308	revents);	553	revents);
309	exit (1);	554	exit (EXIT_FAILURE);
310	}	555	}
311	}	556	}
312		557
313	void	558	#if ENABLE_ICMP
		559	inline void
314	vpn::ipv4_ev (io_watcher &w, short revents)	560	vpn::icmpv4_ev (ev::io &w, int revents)
315	{	561	{
316	if (revents & (POLLIN \| POLLERR))	562	if (revents & EV_READ)
317	{	563	{
318	vpn_packet *pkt = new vpn_packet;	564	vpn_packet *pkt = new vpn_packet;
319	struct sockaddr_in sa;	565	struct sockaddr_in sa;
320	socklen_t sa_len = sizeof (sa);	566	socklen_t sa_len = sizeof (sa);
321	int len;	567	int len;
322		568
323	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);
324		570
325	sockinfo si(sa, PROT_IPv4);	571	sockinfo si(sa, PROT_ICMPv4);
326		572
327	if (len > 0)	573	if (len > 0)
328	{	574	{
329	pkt->len = len;	575	pkt->len = len;
330		576
		577	icmp_header hdr = (icmp_header )&((*pkt)[IP_OVERHEAD]);
		578
		579	if (hdr->type == ::conf.icmp_type
		580	&& hdr->code == 255)
		581	{
331	// 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
332	// this is slow, but...	583	// this is slow, but...
333	pkt->skip_hdr (IP_OVERHEAD);	584	pkt->skip_hdr (ICMP_OVERHEAD);
334		585
335	recv_vpn_packet (pkt, si);	586	recv_vpn_packet (pkt, si);
		587	}
336	}	588	}
337	else	589	else
338	{	590	{
339	// probably ECONNRESET or somesuch	591	// probably ECONNRESET or somesuch
340	slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));	592	slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));
341	}	593	}
342		594
343	delete pkt;	595	delete pkt;
344	}
345	else if (revents & POLLHUP)
346	{
347	// this cannot ;) happen on udp sockets
348	slog (L_ERR, _("FATAL: POLLHUP on ipv4 fd, terminating."));
349	exit (1);
350	}	596	}
351	else	597	else
352	{	598	{
353	slog (L_ERR,	599	slog (L_ERR,
354	_("FATAL: unknown revents %08x in socket, terminating\n"),	600	_("FATAL: unknown revents %08x in socket, terminating\n"),
355	revents);	601	revents);
356	exit (1);	602	exit (EXIT_FAILURE);
		603	}
		604	}
		605	#endif
		606
		607	inline void
		608	vpn::udpv4_ev (ev::io &w, int revents)
		609	{
		610	if (revents & EV_READ)
357	}	611	{
358	}	612	vpn_packet *pkt = new vpn_packet;
		613	struct sockaddr_in sa;
		614	socklen_t sa_len = sizeof (sa);
		615	int len;
359		616
360	void	617	len = recvfrom (w.fd, &((pkt)[0]), MAXSIZE, 0, (sockaddr )&sa, &sa_len);
		618
		619	sockinfo si(sa, PROT_UDPv4);
		620
		621	if (len > 0)
		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
		636	{
		637	slog (L_ERR,
		638	_("FATAL: unknown revents %08x in socket, terminating\n"),
		639	revents);
		640	exit (EXIT_FAILURE);
		641	}
		642	}
		643
		644	inline void
361	vpn::tap_ev (io_watcher &w, short revents)	645	vpn::tap_ev (ev::io &w, int revents)
362	{	646	{
363	if (revents & POLLIN)	647	if (revents & EV_READ)
364	{	648	{
365	/* process data */	649	/* process data */
366	tap_packet *pkt;	650	tap_packet *pkt;
367		651
368	pkt = tap->recv ();	652	pkt = tap->recv ();
369		653
		654	if (!pkt)
		655	return;
		656
		657	if (pkt->len > 14)
		658	{
370	int dst = mac2id (pkt->dst);	659	int dst = mac2id (pkt->dst);
371	int src = mac2id (pkt->src);	660	int src = mac2id (pkt->src);
372		661
373	if (src != THISNODE->id)	662	if (src != THISNODE->id)
374	{
375	slog (L_ERR, _("FATAL: tap packet not originating on current node received, terminating."));
376	exit (1);
377	}
378
379	if (dst == THISNODE->id)
380	{
381	slog (L_ERR, _("FATAL: tap packet destined for current node received, terminating."));
382	exit (1);
383	}
384
385	if (dst > conns.size ())
386	slog (L_ERR, _("tap packet for unknown node %d received, ignoring."), dst);
387	else
388	{
389	if (dst)
390	{	663	{
391	// unicast	664	slog (L_ERR, _("FATAL: tap packet not originating on current node received (if-up script not working properly?), exiting."));
392	if (dst != THISNODE->id)	665	exit (EXIT_FAILURE);
393	conns[dst - 1]->inject_data_packet (pkt);
394	}	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);
395	else	676	else
396	{
397	// broadcast, first check router, then self, then english
398	connection *router = find_router ();
399
400	if (router)
401	router->inject_data_packet (pkt, true);	677	inject_data_packet (pkt, dst);
402	else
403	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
404	if ((*c)->conf != THISNODE)
405	(*c)->inject_data_packet (pkt);
406	}
407	}	678	}
408		679
409	delete pkt;	680	delete pkt;
410	}
411	else if (revents & (POLLHUP \| POLLERR))
412	{
413	slog (L_ERR, _("FATAL: POLLHUP or POLLERR on network device fd, terminating."));
414	exit (1);
415	}	681	}
416	else	682	else
417	abort ();	683	abort ();
418	}	684	}
419		685
420	void	686	inline void
421	vpn::event_cb (time_watcher &w)	687	vpn::event_cb (ev::timer &w, int)
422	{	688	{
423	if (events)	689	if (events)
424	{	690	{
425	if (events & EVENT_SHUTDOWN)	691	if (events & EVENT_SHUTDOWN)
426	{	692	{
427	slog (L_INFO, _("preparing shutdown..."));	693	slog (L_INFO, _("preparing shutdown..."));
428		694
429	shutdown_all ();	695	shutdown_all ();
430
431	remove_pid (pidfilename);	696	remove_pid (conf.pidfilename);
432
433	slog (L_INFO, _("terminating"));	697	slog (L_INFO, _("terminating"));
434		698	exit (EXIT_SUCCESS);
435	exit (0);
436	}	699	}
437		700
438	if (events & EVENT_RECONNECT)	701	if (events & EVENT_RECONNECT)
439	{	702	{
440	slog (L_INFO, _("forced reconnect"));	703	slog (L_INFO, _("forced reconnect"));
…		…
442	reconnect_all ();	705	reconnect_all ();
443	}	706	}
444		707
445	events = 0;	708	events = 0;
446	}	709	}
447
448	w.at = TSTAMP_CANCEL;
449	}	710	}
450		711
451	void	712	void
452	vpn::shutdown_all ()	713	vpn::shutdown_all ()
453	{	714	{
…		…
466	connection_init ();	727	connection_init ();
467		728
468	for (configuration::node_vector::iterator i = conf.nodes.begin ();	729	for (configuration::node_vector::iterator i = conf.nodes.begin ();
469	i != conf.nodes.end (); ++i)	730	i != conf.nodes.end (); ++i)
470	{	731	{
471	connection *conn = new connection (this);	732	connection conn = new connection (this, i);
472
473	conn->conf = *i;
474	conns.push_back (conn);	733	conns.push_back (conn);
475
476	conn->establish_connection ();	734	conn->establish_connection ();
477	}	735	}
478	}	736	}
479		737
480	connection *vpn::find_router ()	738	connection *vpn::find_router ()
481	{	739	{
482	u32 prio = 0;	740	u32 prio = 1;
483	connection *router = 0;	741	connection *router = 0;
484		742
485	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)	743	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
486	{	744	{
487	connection c = i;	745	connection c = i;
488		746
489	if (c->conf->routerprio > prio	747	if (c->conf->routerprio > prio
490	&& c->connectmode == conf_node::C_ALWAYS	748	&& c->connectmode == conf_node::C_ALWAYS // so we don't drop the connection if in use
491	&& c->conf != THISNODE
492	&& c->ictx && c->octx)	749	&& c->ictx && c->octx
		750	&& c->conf != THISNODE) // redundant, since ictx==octx==0 always on thisnode
493	{	751	{
494	prio = c->conf->routerprio;	752	prio = c->conf->routerprio;
495	router = c;	753	router = c;
496	}	754	}
497	}	755	}
…		…
506	if (c)	764	if (c)
507	c->send_connect_request (id);	765	c->send_connect_request (id);
508	else	766	else
509	// no router found, aggressively connect to all routers	767	// no router found, aggressively connect to all routers
510	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)	768	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
511	if ((*i)->conf->routerprio)	769	if ((i)->conf->routerprio && (i)->conf != THISNODE)
512	(*i)->establish_connection ();	770	(*i)->establish_connection ();
513	}	771	}
514		772
515	void	773	void
516	connection::dump_status ()	774	connection::dump_status ()
…		…
518	slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);	776	slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);
519	slog (L_NOTICE, _(" connectmode %d (%d) / sockaddr %s / minor %d"),	777	slog (L_NOTICE, _(" connectmode %d (%d) / sockaddr %s / minor %d"),
520	connectmode, conf->connectmode, (const char *)si, (int)prot_minor);	778	connectmode, conf->connectmode, (const char *)si, (int)prot_minor);
521	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"),
522	(long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);	780	(long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);
523	slog (L_NOTICE, _(" establish_conn %ld / rekey %ld / keepalive %ld"),
524	(long)(establish_connection.at), (long)(rekey.at), (long)(keepalive.at));
525	}	781	}
526		782
527	void	783	void
528	vpn::dump_status ()	784	vpn::dump_status ()
529	{	785	{
530	slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)NOW);	786	slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)ev_now ());
531		787
532	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)	788	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
533	(*c)->dump_status ();	789	(*c)->dump_status ();
534		790
535	slog (L_NOTICE, _("END status dump"));	791	slog (L_NOTICE, _("END status dump"));
536	}	792	}
537		793
538	vpn::vpn (void)	794	vpn::vpn (void)
539	: event(this, &vpn::event_cb)	795	{
		796	event .set<vpn, &vpn::event_cb > (this);
540	, udpv4_ev_watcher(this, &vpn::udpv4_ev)	797	udpv4_ev_watcher .set<vpn, &vpn::udpv4_ev > (this);
541	, ipv4_ev_watcher (this, &vpn::ipv4_ev)	798	ipv4_ev_watcher .set<vpn, &vpn::ipv4_ev > (this);
542	, tap_ev_watcher (this, &vpn::tap_ev)
543	#if ENABLE_TCP	799	#if ENABLE_TCP
544	, tcpv4_ev_watcher(this, &vpn::tcpv4_ev)	800	tcpv4_ev_watcher .set<vpn, &vpn::tcpv4_ev > (this);
545	#endif	801	#endif
546	{	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);
547	}	809	}
548		810
549	vpn::~vpn ()	811	vpn::~vpn ()
550	{	812	{
551	}	813	}

Diff Legend

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

Comparing gvpe/src/vpn.C (file contents): Revision 1.7 by pcg, Sun Apr 6 18:12:18 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.7 by pcg, Sun Apr 6 18:12:18 2003 UTC vs.
Revision 1.48 by pcg, Sat Aug 9 18:30:55 2008 UTC