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

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

Diff Legend

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

Comparing gvpe/src/vpn.C (file contents): Revision 1.35 by pcg, Fri Apr 8 16:12:49 2005 UTC vs. Revision 1.65 by root, Tue Jul 16 16:44:37 2013 UTC

Diff Legend

Comparing gvpe/src/vpn.C (file contents):
Revision 1.35 by pcg, Fri Apr 8 16:12:49 2005 UTC vs.
Revision 1.65 by root, Tue Jul 16 16:44:37 2013 UTC