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

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

Diff Legend

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

Comparing gvpe/src/vpn.C (file contents): Revision 1.38 by pcg, Tue Apr 26 00:55:56 2005 UTC vs. Revision 1.69 by root, Sat Sep 5 17:40:22 2015 UTC

Diff Legend

Comparing gvpe/src/vpn.C (file contents):
Revision 1.38 by pcg, Tue Apr 26 00:55:56 2005 UTC vs.
Revision 1.69 by root, Sat Sep 5 17:40:22 2015 UTC