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

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

Diff Legend

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

Comparing gvpe/src/vpn.C (file contents): Revision 1.40 by pcg, Sat Dec 1 23:35:31 2007 UTC vs. Revision 1.66 by root, Thu Jul 18 13:35:16 2013 UTC

Diff Legend

Comparing gvpe/src/vpn.C (file contents):
Revision 1.40 by pcg, Sat Dec 1 23:35:31 2007 UTC vs.
Revision 1.66 by root, Thu Jul 18 13:35:16 2013 UTC