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

Comparing gvpe/src/vpn.C (file contents):
Revision 1.36 by pcg, Fri Apr 8 16:48:16 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. 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.
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		184
114	#if defined(SOL_IP) && defined(IP_MTU_DISCOVER)	185	#if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
115	// this I really consider a linux bug. I am neither connected	186	// this I really consider a linux bug. I am neither connected
116	// 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
117	// fragment for me sometimes.	188	// fragment for me sometimes.
…		…
123		194
124	sockinfo si (THISNODE, PROT_IPv4);	195	sockinfo si (THISNODE, PROT_IPv4);
125		196
126	if (bind (ipv4_fd, si.sav4 (), si.salenv4 ()))	197	if (bind (ipv4_fd, si.sav4 (), si.salenv4 ()))
127	{	198	{
128	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));
129	exit (EXIT_FAILURE);	200	return -1;
130	}	201	}
131		202
132	ipv4_ev_watcher.start (ipv4_fd, EVENT_READ);	203	ipv4_ev_watcher.start (ipv4_fd, EV_READ);
		204	++success;
133	}	205	}
		206	else
		207	THISNODE->protocols &= ~PROT_IPv4;
134		208
		209	udpv4_tos = -1;
135	udpv4_fd = -1;	210	udpv4_fd = -1;
136		211
137	if (THISNODE->protocols & PROT_UDPv4 && THISNODE->udp_port)	212	if (THISNODE->protocols & PROT_UDPv4 && THISNODE->udp_port)
138	{	213	{
139	udpv4_fd = socket (PF_INET, SOCK_DGRAM, IPPROTO_UDP);	214	udpv4_fd = setup_socket (PROT_UDPv4, PF_INET, SOCK_DGRAM, IPPROTO_UDP);
140		215
141	if (udpv4_fd < 0)	216	if (udpv4_fd < 0)
142	return -1;	217	return -1;
143
144	fcntl (udpv4_fd, F_SETFL, O_NONBLOCK);
145		218
146	// standard daemon practise...	219	// standard daemon practise...
147	{	220	{
148	int oval = 1;	221	int oval = 1;
149	setsockopt (udpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);	222	setsockopt (udpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
…		…
161		234
162	sockinfo si (THISNODE, PROT_UDPv4);	235	sockinfo si (THISNODE, PROT_UDPv4);
163		236
164	if (bind (udpv4_fd, si.sav4 (), si.salenv4 ()))	237	if (bind (udpv4_fd, si.sav4 (), si.salenv4 ()))
165	{	238	{
166	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));
167	exit (EXIT_FAILURE);	240	return -1;
168	}	241	}
169		242
170	udpv4_ev_watcher.start (udpv4_fd, EVENT_READ);	243	udpv4_ev_watcher.start (udpv4_fd, EV_READ);
		244	++success;
171	}	245	}
		246	else
		247	THISNODE->protocols &= ~PROT_UDPv4;
172		248
		249	icmpv4_tos = -1;
173	icmpv4_fd = -1;	250	icmpv4_fd = -1;
174		251
175	#if ENABLE_ICMP	252	#if ENABLE_ICMP
176	if (THISNODE->protocols & PROT_ICMPv4)	253	if (THISNODE->protocols & PROT_ICMPv4)
177	{	254	{
178	icmpv4_fd = socket (PF_INET, SOCK_RAW, IPPROTO_ICMP);	255	icmpv4_fd = setup_socket (PROT_ICMPv4, PF_INET, SOCK_RAW, IPPROTO_ICMP);
179		256
180	if (icmpv4_fd < 0)	257	if (icmpv4_fd < 0)
181	return -1;	258	return -1;
182
183	fcntl (icmpv4_fd, F_SETFL, O_NONBLOCK);
184		259
185	#ifdef ICMP_FILTER	260	#ifdef ICMP_FILTER
186	{	261	{
187	icmp_filter oval;	262	icmp_filter oval;
188	oval.data = 0xffffffff;	263	oval.data = 0xffffffff;
…		…
205		280
206	sockinfo si (THISNODE, PROT_ICMPv4);	281	sockinfo si (THISNODE, PROT_ICMPv4);
207		282
208	if (bind (icmpv4_fd, si.sav4 (), si.salenv4 ()))	283	if (bind (icmpv4_fd, si.sav4 (), si.salenv4 ()))
209	{	284	{
210	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));
211	exit (EXIT_FAILURE);	286	return -1;
212	}	287	}
213		288
214	icmpv4_ev_watcher.start (icmpv4_fd, EVENT_READ);	289	icmpv4_ev_watcher.start (icmpv4_fd, EV_READ);
		290	++success;
215	}	291	}
216	#endif	292	#endif
217		293
218	tcpv4_fd = -1;	294	tcpv4_fd = -1;
219		295
220	#if ENABLE_TCP	296	#if ENABLE_TCP
221	if (THISNODE->protocols & PROT_TCPv4 && THISNODE->tcp_port)	297	if (THISNODE->protocols & PROT_TCPv4 && THISNODE->tcp_port)
222	{	298	{
223	tcpv4_fd = socket (PF_INET, SOCK_STREAM, IPPROTO_TCP);	299	tcpv4_fd = setup_socket (PROT_TCPv4, PF_INET, SOCK_STREAM, IPPROTO_TCP);
224		300
225	if (tcpv4_fd < 0)	301	if (tcpv4_fd < 0)
226	return -1;	302	return -1;
227		303
228	fcntl (tcpv4_fd, F_SETFL, O_NONBLOCK);
229
230	// standard daemon practise...	304	// standard daemon practise...
231	{	305	{
232	int oval = 1;	306	int oval = 1;
233	setsockopt (tcpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);	307	setsockopt (tcpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
234	}	308	}
235		309
236	sockinfo si (THISNODE, PROT_TCPv4);	310	sockinfo si (THISNODE, PROT_TCPv4);
237		311
238	if (bind (tcpv4_fd, si.sav4 (), si.salenv4 ()))	312	if (bind (tcpv4_fd, si.sav4 (), si.salenv4 ()))
239	{	313	{
240	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));
241	exit (EXIT_FAILURE);	315	return -1;
242	}	316	}
243		317
244	if (listen (tcpv4_fd, 5))	318	if (listen (tcpv4_fd, 5))
245	{	319	{
246	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));
247	exit (EXIT_FAILURE);	321	return -1;
248	}	322	}
249		323
250	tcpv4_ev_watcher.start (tcpv4_fd, EVENT_READ);	324	tcpv4_ev_watcher.start (tcpv4_fd, EV_READ);
		325	++success;
251	}	326	}
		327	else
		328	THISNODE->protocols &= ~PROT_TCPv4;
252	#endif	329	#endif
		330
		331	dnsv4_tos = -1;
		332	dnsv4_fd = -1;
253		333
254	#if ENABLE_DNS	334	#if ENABLE_DNS
255	if (THISNODE->protocols & PROT_DNSv4)	335	if (THISNODE->protocols & PROT_DNSv4)
256	{	336	{
257	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);
258		338
259	dnsv4_fd = socket (PF_INET, SOCK_DGRAM, IPPROTO_UDP);	339	dnsv4_fd = setup_socket (PROT_DNSv4, PF_INET, SOCK_DGRAM, IPPROTO_UDP);
260		340
261	if (dnsv4_fd < 0)	341	if (dnsv4_fd < 0)
262	return -1;	342	return -1;
263		343
264	# if defined(SOL_IP) && defined(IP_MTU_DISCOVER)	344	# if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
…		…
281	THISNODE->dns_hostname ? THISNODE->dns_port : 0,	361	THISNODE->dns_hostname ? THISNODE->dns_port : 0,
282	PROT_DNSv4);	362	PROT_DNSv4);
283		363
284	if (bind (dnsv4_fd, si.sav4 (), si.salenv4 ()))	364	if (bind (dnsv4_fd, si.sav4 (), si.salenv4 ()))
285	{	365	{
286	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));
287	exit (EXIT_FAILURE);	367	return -1;
288	}	368	}
289		369
290	dnsv4_ev_watcher.start (dnsv4_fd, EVENT_READ);	370	dnsv4_ev_watcher.start (dnsv4_fd, EV_READ);
		371	++success;
291	}	372	}
292	#endif	373	#endif
293		374
294	/////////////////////////////////////////////////////////////////////////////	375	/////////////////////////////////////////////////////////////////////////////
		376
		377	if (!success)
		378	{
		379	slog (L_ERR, _("no protocols enabled."));
		380	return -1;
		381	}
295		382
296	reconnect_all ();	383	reconnect_all ();
297		384
298	/////////////////////////////////////////////////////////////////////////////	385	/////////////////////////////////////////////////////////////////////////////
299		386
300	tap = new tap_device ();	387	tap = new tap_device ();
301	if (!tap) //D this, of course, never catches	388	if (!tap) //D this, of course, never catches
302	{	389	{
303	slog (L_ERR, _("cannot create network interface '%s'"), conf.ifname);	390	slog (L_ERR, _("cannot create network interface '%s'."), conf.ifname);
304	exit (EXIT_FAILURE);	391	return -1;
305	}	392	}
306		393
		394	fcntl (tap->fd, F_SETFD, FD_CLOEXEC);
		395
		396	run_script_cb cb;
		397	cb.set<vpn, &vpn::script_if_init> (this);
		398
307	if (tap->if_up () &&	399	if (tap->if_up () &&
308	!run_script (run_script_cb (this, &vpn::script_if_init), true))	400	!run_script (cb, true))
309	{	401	{
310	slog (L_ERR, _("interface initialization command '%s' failed, exiting."),	402	slog (L_ERR, _("interface initialization command '%s' failed."),
311	tap->if_up ());	403	tap->if_up ());
312	exit (EXIT_FAILURE);	404	return -1;
313	}
314
315	if (!run_script (run_script_cb (this, &vpn::script_if_up), true))
316	{	405	}
		406
		407	cb.set<vpn, &vpn::script_if_up> (this);
		408	if (!run_script (cb, true))
		409	{
317	slog (L_ERR, _("if-up command execution failed, exiting."));	410	slog (L_ERR, _("if-up command execution failed."));
318	exit (EXIT_FAILURE);	411	return -1;
319	}	412	}
320		413
321	tap_ev_watcher.start (tap->fd, EVENT_READ);	414	tap_ev_watcher.start (tap->fd, EV_READ);
322		415
323	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;
324	}	485	}
325		486
326	bool	487	bool
327	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)
328	{	489	{
329	#if defined(SOL_IP) && defined(IP_TOS)	490	set_tos (ipv4_fd, ipv4_tos, tos);
330	setsockopt (ipv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
331	#endif
332	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 ());
333		492
334	return true;	493	return true;
335	}	494	}
336		495
337	static u16	496	static u16
…		…
359		518
360	#if ENABLE_ICMP	519	#if ENABLE_ICMP
361	bool	520	bool
362	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)
363	{	522	{
364	#if defined(SOL_IP) && defined(IP_TOS)
365	setsockopt (icmpv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
366	#endif
367
368	pkt->unshift_hdr (4);	523	pkt->unshift_hdr (4);
369		524
370	icmp_header hdr = (icmp_header )&((*pkt)[0]);	525	icmp_header hdr = (icmp_header )&((*pkt)[0]);
371	hdr->type = ::conf.icmp_type;	526	hdr->type = ::conf.icmp_type;
372	hdr->code = 255;	527	hdr->code = 255;
373	hdr->checksum = 0;	528	hdr->checksum = 0;
374	hdr->checksum = ipv4_checksum ((u16 *)hdr, pkt->len);	529	hdr->checksum = ipv4_checksum ((u16 *)hdr, pkt->len);
375		530
		531	set_tos (icmpv4_fd, icmpv4_tos, tos);
376	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 ());
377		533
378	return true;	534	return true;
379	}	535	}
380	#endif	536	#endif
381		537
382	bool	538	bool
383	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)
384	{	540	{
385	#if defined(SOL_IP) && defined(IP_TOS)	541	set_tos (udpv4_fd, udpv4_tos, tos);
386	setsockopt (udpv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
387	#endif
388	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 ());
389		543
390	return true;	544	return true;
391	}	545	}
392		546
393	void	547	void
…		…
403	{	557	{
404	// broadcast, this is ugly, but due to the security policy	558	// broadcast, this is ugly, but due to the security policy
405	// we have to connect to all hosts...	559	// we have to connect to all hosts...
406	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)	560	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
407	if ((*c)->conf != THISNODE)	561	if ((*c)->conf != THISNODE)
408	(*c)->inject_data_packet (pkt, true);	562	(*c)->inject_data_packet (pkt);
409	}	563	}
410	}	564	}
411		565
412	void	566	void
413	vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)	567	vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)
414	{	568	{
415	unsigned int src = pkt->src ();	569	unsigned int src = pkt->src ();
416	unsigned int dst = pkt->dst ();	570	unsigned int dst = pkt->dst ();
417		571
418	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."),
419	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst (), pkt->len);	573	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst (), pkt->len);
420		574
421	if (src == 0 \|\| src > conns.size ()	575	if (src == 0 \|\| src > conns.size ()
422	\|\| dst > conns.size ()	576	\|\| dst > conns.size ()
423	\|\| pkt->typ () >= vpn_packet::PT_MAX)	577	\|\| pkt->typ () >= vpn_packet::PT_MAX)
424	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)."),
425	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
426	else if (dst > conns.size ())
427	slog (L_WARN, _("(%s): received corrupted packet type %d (src %d, dst %d)"),
428	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());	579	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
429	else	580	else
430	{	581	{
431	connection *c = conns[src - 1];	582	connection *c = conns[src - 1];
432		583
433	if (dst == 0)	584	if (dst == 0)
434	slog (L_WARN, _("%s(%s): received broadcast (protocol violation)"),	585	slog (L_WARN, _("%s(%s): received broadcast (protocol violation)."),
435	c->conf->nodename, (const char *)rsi);	586	c->conf->nodename, (const char *)rsi);
436	else if (dst != THISNODE->id)	587	else if (dst != THISNODE->id)
437	{	588	{
438	if (THISNODE->routerprio)	589	if (THISNODE->routerprio)
439	// the tos setting gets lost here. who cares.	590	// the tos setting gets lost here. who cares.
440	conns[dst - 1]->inject_vpn_packet (pkt);	591	conns[dst - 1]->inject_vpn_packet (pkt);
441	else	592	else
442	slog (L_WARN,	593	slog (L_WARN,
443	_("%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?)."),
444	c->conf->nodename, (const char *)rsi,	595	c->conf->nodename, (const char *)rsi,
445	conns[dst - 1]->conf->nodename);	596	conns[dst - 1]->conf->nodename);
446	}	597	}
447	else	598	else
448	c->recv_vpn_packet (pkt, rsi);	599	c->recv_vpn_packet (pkt, rsi);
…		…
453	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)
454	{	605	{
455	switch (si.prot)	606	switch (si.prot)
456	{	607	{
457	case PROT_IPv4:	608	case PROT_IPv4:
458	return send_ipv4_packet (pkt, si, tos);	609	return send_ipv4_packet (pkt, si, tos);
		610
459	case PROT_UDPv4:	611	case PROT_UDPv4:
460	return send_udpv4_packet (pkt, si, tos);	612	return send_udpv4_packet (pkt, si, tos);
		613
461	#if ENABLE_TCP	614	#if ENABLE_TCP
462	case PROT_TCPv4:	615	case PROT_TCPv4:
463	return send_tcpv4_packet (pkt, si, tos);	616	return send_tcpv4_packet (pkt, si, tos);
464	#endif	617	#endif
465	#if ENABLE_ICMP	618	#if ENABLE_ICMP
466	case PROT_ICMPv4:	619	case PROT_ICMPv4:
467	return send_icmpv4_packet (pkt, si, tos);	620	return send_icmpv4_packet (pkt, si, tos);
468	#endif	621	#endif
469	#if ENABLE_DNS	622	#if ENABLE_DNS
470	case PROT_DNSv4:	623	case PROT_DNSv4:
471	return send_dnsv4_packet (pkt, si, tos);	624	return send_dnsv4_packet (pkt, si, tos);
472	#endif	625	#endif
473
474	default:	626	default:
475	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);
476	}	628	}
477		629
478	return false;	630	return false;
479	}	631	}
480		632
481	void	633	inline void
482	vpn::ipv4_ev (io_watcher &w, short revents)	634	vpn::ipv4_ev (ev::io &w, int revents)
483	{	635	{
484	if (revents & EVENT_READ)	636	if (revents & EV_READ)
485	{	637	{
486	vpn_packet *pkt = new vpn_packet;	638	vpn_packet *pkt = new vpn_packet;
487	struct sockaddr_in sa;	639	struct sockaddr_in sa;
488	socklen_t sa_len = sizeof (sa);	640	socklen_t sa_len = sizeof (sa);
489	int len;	641	int len;
…		…
495	if (len > 0)	647	if (len > 0)
496	{	648	{
497	pkt->len = len;	649	pkt->len = len;
498		650
499	// 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
500	pkt->skip_hdr (IP_OVERHEAD);	652	pkt->skip_hdr (pkt->ipv4_hdr_len ());
501		653
502	recv_vpn_packet (pkt, si);	654	recv_vpn_packet (pkt, si);
503	}	655	}
504	else	656	else
505	{	657	{
506	// probably ECONNRESET or somesuch	658	// probably ECONNRESET or somesuch
507	slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));	659	slog (L_DEBUG, _("%s: %s."), (const char *)si, strerror (errno));
508	}	660	}
509		661
510	delete pkt;	662	delete pkt;
511	}	663	}
512	else	664	else
513	{	665	{
514	slog (L_ERR,	666	slog (L_ERR,
515	_("FATAL: unknown revents %08x in socket, terminating\n"),	667	_("FATAL: unknown revents %08x in socket, exiting.\n"),
516	revents);	668	revents);
517	exit (EXIT_FAILURE);	669	exit (EXIT_FAILURE);
518	}	670	}
519	}	671	}
520		672
521	#if ENABLE_ICMP	673	#if ENABLE_ICMP
522	void	674	inline void
523	vpn::icmpv4_ev (io_watcher &w, short revents)	675	vpn::icmpv4_ev (ev::io &w, int revents)
524	{	676	{
525	if (revents & EVENT_READ)	677	if (revents & EV_READ)
526	{	678	{
527	vpn_packet *pkt = new vpn_packet;	679	vpn_packet *pkt = new vpn_packet;
528	struct sockaddr_in sa;	680	struct sockaddr_in sa;
529	socklen_t sa_len = sizeof (sa);	681	socklen_t sa_len = sizeof (sa);
530	int len;	682	int len;
…		…
542	if (hdr->type == ::conf.icmp_type	694	if (hdr->type == ::conf.icmp_type
543	&& hdr->code == 255)	695	&& hdr->code == 255)
544	{	696	{
545	// 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
546	// this is slow, but...	698	// this is slow, but...
547	pkt->skip_hdr (ICMP_OVERHEAD);	699	pkt->skip_hdr (pkt->ipv4_hdr_len () + (ICMP_OVERHEAD - IP_OVERHEAD));
548		700
549	recv_vpn_packet (pkt, si);	701	recv_vpn_packet (pkt, si);
550	}	702	}
551	}	703	}
552	else	704	else
553	{	705	{
554	// probably ECONNRESET or somesuch	706	// probably ECONNRESET or somesuch
555	slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));	707	slog (L_DEBUG, _("%s: %s."), (const char *)si, strerror (errno));
556	}	708	}
557		709
558	delete pkt;	710	delete pkt;
559	}	711	}
560	else	712	else
561	{	713	{
562	slog (L_ERR,	714	slog (L_ERR,
563	_("FATAL: unknown revents %08x in socket, terminating\n"),	715	_("FATAL: unknown revents %08x in socket, exiting.\n"),
564	revents);	716	revents);
565	exit (EXIT_FAILURE);	717	exit (EXIT_FAILURE);
566	}	718	}
567	}	719	}
568	#endif	720	#endif
569		721
570	void	722	inline void
571	vpn::udpv4_ev (io_watcher &w, short revents)	723	vpn::udpv4_ev (ev::io &w, int revents)
572	{	724	{
573	if (revents & EVENT_READ)	725	if (revents & EV_READ)
574	{	726	{
575	vpn_packet *pkt = new vpn_packet;	727	vpn_packet *pkt = new vpn_packet;
576	struct sockaddr_in sa;	728	struct sockaddr_in sa;
577	socklen_t sa_len = sizeof (sa);	729	socklen_t sa_len = sizeof (sa);
578	int len;	730	int len;
…		…
588	recv_vpn_packet (pkt, si);	740	recv_vpn_packet (pkt, si);
589	}	741	}
590	else	742	else
591	{	743	{
592	// probably ECONNRESET or somesuch	744	// probably ECONNRESET or somesuch
593	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));
594	}	746	}
595		747
596	delete pkt;	748	delete pkt;
597	}	749	}
598	else	750	else
599	{	751	{
600	slog (L_ERR,	752	slog (L_ERR,
601	_("FATAL: unknown revents %08x in socket, terminating\n"),	753	_("FATAL: unknown revents %08x in socket, exiting.\n"),
602	revents);	754	revents);
603	exit (EXIT_FAILURE);	755	exit (EXIT_FAILURE);
604	}	756	}
605	}	757	}
606		758
607	void	759	inline void
608	vpn::tap_ev (io_watcher &w, short revents)	760	vpn::tap_ev (ev::io &w, int revents)
609	{	761	{
610	if (revents & EVENT_READ)	762	if (revents & EV_READ)
611	{	763	{
612	/* process data */	764	/* process data */
613	tap_packet *pkt;	765	tap_packet *pkt;
614		766
615	pkt = tap->recv ();	767	pkt = tap->recv ();
…		…
644	}	796	}
645	else	797	else
646	abort ();	798	abort ();
647	}	799	}
648		800
649	void	801	inline void
650	vpn::event_cb (time_watcher &w)	802	vpn::event_cb (ev::timer &w, int)
651	{	803	{
652	if (events)	804	if (events)
653	{	805	{
654	if (events & EVENT_SHUTDOWN)	806	if (events & EVENT_SHUTDOWN)
655	{	807	{
656	slog (L_INFO, _("preparing shutdown..."));	808	slog (L_INFO, _("preparing shutdown..."));
657		809
658	shutdown_all ();	810	shutdown_all ();
659	remove_pid (conf.pidfilename);	811	remove_pid (conf.pidfilename);
660	slog (L_INFO, _("terminating"));	812	slog (L_INFO, _("exiting."));
661	exit (EXIT_SUCCESS);	813	exit (EXIT_SUCCESS);
662	}	814	}
663		815
664	if (events & EVENT_RECONNECT)	816	if (events & EVENT_RECONNECT)
665	{	817	{
666	slog (L_INFO, _("forced reconnect"));	818	slog (L_INFO, _("forced reconnect."));
667		819
668	reconnect_all ();	820	reconnect_all ();
669	}	821	}
670		822
671	events = 0;	823	events = 0;
…		…
687		839
688	conns.clear ();	840	conns.clear ();
689		841
690	connection_init ();	842	connection_init ();
691		843
692	for (configuration::node_vector::iterator i = conf.nodes.begin ();	844	for (configuration::node_vector::iterator i = conf.nodes.begin (); i != conf.nodes.end (); ++i)
693	i != conf.nodes.end (); ++i)	845	conns.push_back (new connection (this, *i));
694	{	846
695	connection conn = new connection (this, i);	847	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
696	conns.push_back (conn);
697	conn->establish_connection ();	848	(*c)->establish_connection ();
698	}
699	}	849	}
700		850
701	connection *vpn::find_router ()	851	bool
		852	vpn::can_direct (conf_node src, conf_node dst) const
702	{	853	{
703	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	{
704	connection *router = 0;	866	connection *router = 0;
705		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	{
706	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)	916	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
707	{	917	{
708	connection c = i;	918	connection o = i;
709		919
710	if (c->conf->routerprio > prio	920	if (o->si.valid ()
711	&& c->connectmode == conf_node::C_ALWAYS // so we don't drop the connection if in use	921	&& c->si != o->si
712	&& c->ictx && c->octx	922	&& c == find_router_for (o)
713	&& c->conf != THISNODE) // redundant, since ictx==octx==0 always on thisnode	923	&& !can_direct (THISNODE, o->conf))
714	{
715	prio = c->conf->routerprio;
716	router = c;
717	}	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	}
718	}	929	}
719
720	return router;
721	}	930	}
722		931
		932	void
723	void vpn::send_connect_request (int id)	933	vpn::send_connect_request (connection *c)
724	{	934	{
725	connection *c = find_router ();	935	connection *r = find_router_for (c);
726		936
727	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);
728	c->send_connect_request (id);	941	r->send_connect_request (c->conf->id);
		942	}
729	else	943	else
730	// 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."),
731	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)	945	c->conf->nodename);
732	if ((i)->conf->routerprio && (i)->conf != THISNODE)
733	(*i)->establish_connection ();
734	}	946	}
735		947
736	void	948	void
737	connection::dump_status ()	949	connection::dump_status ()
738	{	950	{
739	slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);	951	slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);
740	slog (L_NOTICE, _(" connectmode %d (%d) / sockaddr %s / minor %d"),	952	slog (L_NOTICE, _(" connectmode %d (%d) / sockaddr %s / minor %d"),
741	connectmode, conf->connectmode, (const char *)si, (int)prot_minor);	953	connectmode, conf->connectmode, (const char *)si, (int)prot_minor);
742	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"),
743	(long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);	955	(long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);
744	slog (L_NOTICE, _(" establish_conn %ld / rekey %ld / keepalive %ld"),
745	(long)(establish_connection.at), (long)(rekey.at), (long)(keepalive.at));
746	}	956	}
747		957
748	void	958	void
749	vpn::dump_status ()	959	vpn::dump_status ()
750	{	960	{
751	slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)NOW);	961	slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)ev_now ());
752		962
753	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)	963	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
754	(*c)->dump_status ();	964	(*c)->dump_status ();
755		965
756	slog (L_NOTICE, _("END status dump"));	966	slog (L_NOTICE, _("END status dump"));
757	}	967	}
758		968
759	vpn::vpn (void)	969	vpn::vpn (void)
		970	{
760	: event (this, &vpn::event_cb)	971	event .set<vpn, &vpn::event_cb > (this);
761	, udpv4_ev_watcher (this, &vpn::udpv4_ev)	972	udpv4_ev_watcher .set<vpn, &vpn::udpv4_ev > (this);
762	, ipv4_ev_watcher (this, &vpn::ipv4_ev)	973	ipv4_ev_watcher .set<vpn, &vpn::ipv4_ev > (this);
763	#if ENABLE_TCP	974	#if ENABLE_TCP
764	, tcpv4_ev_watcher (this, &vpn::tcpv4_ev)	975	tcpv4_ev_watcher .set<vpn, &vpn::tcpv4_ev > (this);
765	#endif	976	#endif
766	#if ENABLE_ICMP	977	#if ENABLE_ICMP
767	, icmpv4_ev_watcher(this, &vpn::icmpv4_ev)	978	icmpv4_ev_watcher.set<vpn, &vpn::icmpv4_ev> (this);
768	#endif	979	#endif
769	#if ENABLE_DNS	980	#if ENABLE_DNS
770	, dnsv4_ev_watcher (this, &vpn::dnsv4_ev)	981	dnsv4_ev_watcher .set<vpn, &vpn::dnsv4_ev > (this);
771	#endif	982	#endif
772	, tap_ev_watcher (this, &vpn::tap_ev)	983	tap_ev_watcher .set<vpn, &vpn::tap_ev > (this);
773	{
774	}	984	}
775		985
776	vpn::~vpn ()	986	vpn::~vpn ()
777	{	987	{
778	}	988	}

Diff Legend

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

Comparing gvpe/src/vpn.C (file contents): Revision 1.36 by pcg, Fri Apr 8 16:48:16 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.36 by pcg, Fri Apr 8 16:48:16 2005 UTC vs.
Revision 1.69 by root, Sat Sep 5 17:40:22 2015 UTC