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

Comparing gvpe/src/vpn.C (file contents):
Revision 1.32 by pcg, Mon Mar 7 01:31:26 2005 UTC vs.
Revision 1.64 by root, Tue Dec 4 10:29:43 2012 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 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	/////////////////////////////////////////////////////////////////////////////
50		63
51	const char *vpn::script_if_up ()	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	}
		75
		76	void
		77	vpn::script_init_env ()
52	{	78	{
53	// the tunnel device mtu should be the physical mtu - overhead	79	// the tunnel device mtu should be the physical mtu - overhead
54	// the tricky part is rounding to the cipher key blocksize	80	// the tricky part is rounding to the cipher key blocksize
55	int mtu = conf.mtu - ETH_OVERHEAD - VPE_OVERHEAD - MAX_OVERHEAD;	81	int mtu = conf.mtu - ETH_OVERHEAD - VPE_OVERHEAD - MAX_OVERHEAD;
56	mtu += ETH_OVERHEAD - 6 - 6; // now we have the data portion	82	mtu += ETH_OVERHEAD - 6 - 6; // now we have the data portion
57	mtu -= mtu % EVP_CIPHER_block_size (CIPHER); // round	83	mtu -= mtu % EVP_CIPHER_block_size (CIPHER); // round
58	mtu -= ETH_OVERHEAD - 6 - 6; // and get interface mtu again	84	mtu -= ETH_OVERHEAD - 6 - 6; // and get interface mtu again
59		85
60	char *env;	86	char *env;
61	asprintf (&env, "CONFBASE=%s", confbase); putenv (env);	87	asprintf (&env, "CONFBASE=%s", confbase); putenv (env);
62	asprintf (&env, "NODENAME=%s", THISNODE->nodename); putenv (env);
63	asprintf (&env, "NODEID=%d", THISNODE->id); putenv (env);
64	asprintf (&env, "IFNAME=%s", tap->interface ()); putenv (env);	88	asprintf (&env, "IFNAME=%s", tap->interface ()); putenv (env);
65	asprintf (&env, "IFTYPE=%s", IFTYPE); putenv (env);	89	asprintf (&env, "IFTYPE=%s", IFTYPE); putenv (env);
66	asprintf (&env, "IFSUBTYPE=%s", IFSUBTYPE); putenv (env);	90	asprintf (&env, "IFSUBTYPE=%s", IFSUBTYPE); putenv (env);
67	asprintf (&env, "MTU=%d", mtu); putenv (env);	91	asprintf (&env, "MTU=%d", mtu); putenv (env);
68	asprintf (&env, "MAC=%02x:%02x:%02x:%02x:%02x:%02x",	92	asprintf (&env, "NODES=%d", conns.size ()); putenv (env);
69	0xfe, 0xfd, 0x80, 0x00, THISNODE->id >> 8,	93	asprintf (&env, "NODEID=%d", THISNODE->id); putenv (env);
70	THISNODE->id & 0xff);
71	putenv (env);
72		94
		95	conns [THISNODE->id - 1]->script_init_env ("");
		96
		97	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
		98	{
		99	char ext[16];
		100	snprintf (ext, 16, "_%d", (*c)->conf->id);
		101	(*c)->script_init_env (ext);
		102	}
		103	}
		104
		105	inline const char *
		106	vpn::script_if_init ()
		107	{
		108	script_init_env ();
		109
		110	return tap->if_up ();
		111	}
		112
		113	inline const char *
		114	vpn::script_if_up ()
		115	{
		116	script_init_env ();
		117
		118	char *filename;
		119	asprintf (&filename,
		120	"%s/%s",
		121	confbase,
73	return ::conf.script_if_up ? ::conf.script_if_up : "if-up";	122	::conf.script_if_up ? ::conf.script_if_up : "if-up");
		123
		124	return filename;
		125	}
		126
		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;
74	}	148	}
75		149
76	int	150	int
77	vpn::setup ()	151	vpn::setup ()
78	{	152	{
		153	int success = 0;
		154
		155	ipv4_tos = -1;
79	ipv4_fd = -1;	156	ipv4_fd = -1;
80		157
81	if (THISNODE->protocols & PROT_IPv4 && ::conf.ip_proto)	158	if (THISNODE->protocols & PROT_IPv4 && ::conf.ip_proto)
82	{	159	{
83	ipv4_fd = socket (PF_INET, SOCK_RAW, ::conf.ip_proto);	160	ipv4_fd = setup_socket (PROT_IPv4, PF_INET, SOCK_RAW, ::conf.ip_proto);
84		161
85	if (ipv4_fd < 0)	162	if (ipv4_fd < 0)
86	return -1;	163	return -1;
87
88	fcntl (ipv4_fd, F_SETFL, O_NONBLOCK);
89		164
90	#if defined(SOL_IP) && defined(IP_MTU_DISCOVER)	165	#if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
91	// this I really consider a linux bug. I am neither connected	166	// this I really consider a linux bug. I am neither connected
92	// 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
93	// fragment for me sometimes.	168	// fragment for me sometimes.
…		…
99		174
100	sockinfo si (THISNODE, PROT_IPv4);	175	sockinfo si (THISNODE, PROT_IPv4);
101		176
102	if (bind (ipv4_fd, si.sav4 (), si.salenv4 ()))	177	if (bind (ipv4_fd, si.sav4 (), si.salenv4 ()))
103	{	178	{
104	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));
105	exit (EXIT_FAILURE);	180	return -1;
106	}	181	}
107		182
108	ipv4_ev_watcher.start (ipv4_fd, EVENT_READ);	183	ipv4_ev_watcher.start (ipv4_fd, EV_READ);
		184	++success;
109	}	185	}
		186	else
		187	THISNODE->protocols &= ~PROT_IPv4;
110		188
		189	udpv4_tos = -1;
111	udpv4_fd = -1;	190	udpv4_fd = -1;
112		191
113	if (THISNODE->protocols & PROT_UDPv4 && THISNODE->udp_port)	192	if (THISNODE->protocols & PROT_UDPv4 && THISNODE->udp_port)
114	{	193	{
115	udpv4_fd = socket (PF_INET, SOCK_DGRAM, IPPROTO_UDP);	194	udpv4_fd = setup_socket (PROT_UDPv4, PF_INET, SOCK_DGRAM, IPPROTO_UDP);
116		195
117	if (udpv4_fd < 0)	196	if (udpv4_fd < 0)
118	return -1;	197	return -1;
119
120	fcntl (udpv4_fd, F_SETFL, O_NONBLOCK);
121		198
122	// standard daemon practise...	199	// standard daemon practise...
123	{	200	{
124	int oval = 1;	201	int oval = 1;
125	setsockopt (udpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);	202	setsockopt (udpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
…		…
137		214
138	sockinfo si (THISNODE, PROT_UDPv4);	215	sockinfo si (THISNODE, PROT_UDPv4);
139		216
140	if (bind (udpv4_fd, si.sav4 (), si.salenv4 ()))	217	if (bind (udpv4_fd, si.sav4 (), si.salenv4 ()))
141	{	218	{
142	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));
143	exit (EXIT_FAILURE);	220	return -1;
144	}	221	}
145		222
146	udpv4_ev_watcher.start (udpv4_fd, EVENT_READ);	223	udpv4_ev_watcher.start (udpv4_fd, EV_READ);
		224	++success;
147	}	225	}
		226	else
		227	THISNODE->protocols &= ~PROT_UDPv4;
148		228
		229	icmpv4_tos = -1;
149	icmpv4_fd = -1;	230	icmpv4_fd = -1;
150		231
151	#if ENABLE_ICMP	232	#if ENABLE_ICMP
152	if (THISNODE->protocols & PROT_ICMPv4)	233	if (THISNODE->protocols & PROT_ICMPv4)
153	{	234	{
154	icmpv4_fd = socket (PF_INET, SOCK_RAW, IPPROTO_ICMP);	235	icmpv4_fd = setup_socket (PROT_ICMPv4, PF_INET, SOCK_RAW, IPPROTO_ICMP);
155		236
156	if (icmpv4_fd < 0)	237	if (icmpv4_fd < 0)
157	return -1;	238	return -1;
158
159	fcntl (icmpv4_fd, F_SETFL, O_NONBLOCK);
160		239
161	#ifdef ICMP_FILTER	240	#ifdef ICMP_FILTER
162	{	241	{
163	icmp_filter oval;	242	icmp_filter oval;
164	oval.data = 0xffffffff;	243	oval.data = 0xffffffff;
…		…
173	// this I really consider a linux bug. I am neither connected	252	// this I really consider a linux bug. I am neither connected
174	// 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
175	// fragment for me sometimes.	254	// fragment for me sometimes.
176	{	255	{
177	int oval = IP_PMTUDISC_DONT;	256	int oval = IP_PMTUDISC_DONT;
178	setsockopt (udpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);	257	setsockopt (icmpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
179	}	258	}
180	#endif	259	#endif
181		260
182	sockinfo si (THISNODE, PROT_ICMPv4);	261	sockinfo si (THISNODE, PROT_ICMPv4);
183		262
184	if (bind (icmpv4_fd, si.sav4 (), si.salenv4 ()))	263	if (bind (icmpv4_fd, si.sav4 (), si.salenv4 ()))
185	{	264	{
186	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));
187	exit (EXIT_FAILURE);	266	return -1;
188	}	267	}
189		268
190	icmpv4_ev_watcher.start (icmpv4_fd, EVENT_READ);	269	icmpv4_ev_watcher.start (icmpv4_fd, EV_READ);
		270	++success;
191	}	271	}
192	#endif	272	#endif
193		273
194	tcpv4_fd = -1;	274	tcpv4_fd = -1;
195		275
196	#if ENABLE_TCP	276	#if ENABLE_TCP
197	if (THISNODE->protocols & PROT_TCPv4 && THISNODE->tcp_port)	277	if (THISNODE->protocols & PROT_TCPv4 && THISNODE->tcp_port)
198	{	278	{
199	tcpv4_fd = socket (PF_INET, SOCK_STREAM, IPPROTO_TCP);	279	tcpv4_fd = setup_socket (PROT_TCPv4, PF_INET, SOCK_STREAM, IPPROTO_TCP);
200		280
201	if (tcpv4_fd < 0)	281	if (tcpv4_fd < 0)
202	return -1;	282	return -1;
203		283
204	fcntl (tcpv4_fd, F_SETFL, O_NONBLOCK);
205
206	// standard daemon practise...	284	// standard daemon practise...
207	{	285	{
208	int oval = 1;	286	int oval = 1;
209	setsockopt (tcpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);	287	setsockopt (tcpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
210	}	288	}
211		289
212	sockinfo si (THISNODE, PROT_TCPv4);	290	sockinfo si (THISNODE, PROT_TCPv4);
213		291
214	if (bind (tcpv4_fd, si.sav4 (), si.salenv4 ()))	292	if (bind (tcpv4_fd, si.sav4 (), si.salenv4 ()))
215	{	293	{
216	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));
217	exit (EXIT_FAILURE);	295	return -1;
218	}	296	}
219		297
220	if (listen (tcpv4_fd, 5))	298	if (listen (tcpv4_fd, 5))
221	{	299	{
222	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));
223	exit (EXIT_FAILURE);	301	return -1;
224	}	302	}
225		303
226	tcpv4_ev_watcher.start (tcpv4_fd, EVENT_READ);	304	tcpv4_ev_watcher.start (tcpv4_fd, EV_READ);
		305	++success;
227	}	306	}
		307	else
		308	THISNODE->protocols &= ~PROT_TCPv4;
228	#endif	309	#endif
		310
		311	dnsv4_tos = -1;
		312	dnsv4_fd = -1;
229		313
230	#if ENABLE_DNS	314	#if ENABLE_DNS
231	if (THISNODE->protocols & PROT_DNSv4)	315	if (THISNODE->protocols & PROT_DNSv4)
232	{	316	{
233	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);
234		318
235	dnsv4_fd = socket (PF_INET, SOCK_DGRAM, IPPROTO_UDP);	319	dnsv4_fd = setup_socket (PROT_DNSv4, PF_INET, SOCK_DGRAM, IPPROTO_UDP);
236		320
237	if (dnsv4_fd < 0)	321	if (dnsv4_fd < 0)
238	return -1;	322	return -1;
239		323
240	#if defined(SOL_IP) && defined(IP_MTU_DISCOVER)	324	# if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
241	// this I really consider a linux bug. I am neither connected	325	// this I really consider a linux bug. I am neither connected
242	// nor do I fragment myself. Linux still sets DF and doesn't	326	// nor do I fragment myself. Linux still sets DF and doesn't
243	// fragment for me sometimes.	327	// fragment for me sometimes.
244	{	328	{
245	int oval = IP_PMTUDISC_DONT;	329	int oval = IP_PMTUDISC_DONT;
246	setsockopt (udpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);	330	setsockopt (dnsv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
247	}	331	}
248	#endif	332	# endif
249		333
250	// standard daemon practise...	334	// standard daemon practise...
251	{	335	{
252	int oval = 1;	336	int oval = 1;
253	setsockopt (dnsv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);	337	setsockopt (dnsv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
…		…
257	THISNODE->dns_hostname ? THISNODE->dns_port : 0,	341	THISNODE->dns_hostname ? THISNODE->dns_port : 0,
258	PROT_DNSv4);	342	PROT_DNSv4);
259		343
260	if (bind (dnsv4_fd, si.sav4 (), si.salenv4 ()))	344	if (bind (dnsv4_fd, si.sav4 (), si.salenv4 ()))
261	{	345	{
262	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));
263	exit (EXIT_FAILURE);	347	return -1;
264	}	348	}
265		349
266	dnsv4_ev_watcher.start (dnsv4_fd, EVENT_READ);	350	dnsv4_ev_watcher.start (dnsv4_fd, EV_READ);
		351	++success;
		352	}
		353	#endif
		354
		355	/////////////////////////////////////////////////////////////////////////////
		356
		357	if (!success)
267	}	358	{
268	#endif	359	slog (L_ERR, _("no protocols enabled."));
		360	return -1;
		361	}
		362
		363	reconnect_all ();
		364
		365	/////////////////////////////////////////////////////////////////////////////
269		366
270	tap = new tap_device ();	367	tap = new tap_device ();
271	if (!tap) //D this, of course, never catches	368	if (!tap) //D this, of course, never catches
272	{	369	{
273	slog (L_ERR, _("cannot create network interface '%s'"), conf.ifname);	370	slog (L_ERR, _("cannot create network interface '%s'."), conf.ifname);
274	exit (EXIT_FAILURE);	371	return -1;
275	}	372	}
276		373
277	run_script (run_script_cb (this, &vpn::script_if_up), true);	374	fcntl (tap->fd, F_SETFD, FD_CLOEXEC);
278		375
		376	run_script_cb cb;
		377	cb.set<vpn, &vpn::script_if_init> (this);
		378
		379	if (tap->if_up () &&
		380	!run_script (cb, true))
		381	{
		382	slog (L_ERR, _("interface initialization command '%s' failed."),
		383	tap->if_up ());
		384	return -1;
		385	}
		386
		387	cb.set<vpn, &vpn::script_if_up> (this);
		388	if (!run_script (cb, true))
		389	{
		390	slog (L_ERR, _("if-up command execution failed."));
		391	return -1;
		392	}
		393
279	tap_ev_watcher.start (tap->fd, EVENT_READ);	394	tap_ev_watcher.start (tap->fd, EV_READ);
280
281	reconnect_all ();
282		395
283	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;
284	}	465	}
285		466
286	bool	467	bool
287	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)
288	{	469	{
289	#if defined(SOL_IP) && defined(IP_TOS)	470	set_tos (ipv4_fd, ipv4_tos, tos);
290	setsockopt (ipv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
291	#endif
292	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 ());
293		472
294	return true;	473	return true;
295	}	474	}
296		475
…		…
319		498
320	#if ENABLE_ICMP	499	#if ENABLE_ICMP
321	bool	500	bool
322	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)
323	{	502	{
324	#if defined(SOL_IP) && defined(IP_TOS)
325	setsockopt (icmpv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
326	#endif
327
328	pkt->unshift_hdr (4);	503	pkt->unshift_hdr (4);
329		504
330	icmp_header hdr = (icmp_header )&((*pkt)[0]);	505	icmp_header hdr = (icmp_header )&((*pkt)[0]);
331	hdr->type = ::conf.icmp_type;	506	hdr->type = ::conf.icmp_type;
332	hdr->code = 255;	507	hdr->code = 255;
333	hdr->checksum = 0;	508	hdr->checksum = 0;
334	hdr->checksum = ipv4_checksum ((u16 *)hdr, pkt->len);	509	hdr->checksum = ipv4_checksum ((u16 *)hdr, pkt->len);
335		510
		511	set_tos (icmpv4_fd, icmpv4_tos, tos);
336	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 ());
337		513
338	return true;	514	return true;
339	}	515	}
340	#endif	516	#endif
341		517
342	bool	518	bool
343	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)
344	{	520	{
345	#if defined(SOL_IP) && defined(IP_TOS)	521	set_tos (udpv4_fd, udpv4_tos, tos);
346	setsockopt (udpv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
347	#endif
348	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 ());
349		523
350	return true;	524	return true;
351	}	525	}
352		526
…		…
363	{	537	{
364	// broadcast, this is ugly, but due to the security policy	538	// broadcast, this is ugly, but due to the security policy
365	// we have to connect to all hosts...	539	// we have to connect to all hosts...
366	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)	540	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
367	if ((*c)->conf != THISNODE)	541	if ((*c)->conf != THISNODE)
368	(*c)->inject_data_packet (pkt, true);	542	(*c)->inject_data_packet (pkt);
369	}	543	}
370	}	544	}
371		545
372	void	546	void
373	vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)	547	vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)
374	{	548	{
375	unsigned int src = pkt->src ();	549	unsigned int src = pkt->src ();
376	unsigned int dst = pkt->dst ();	550	unsigned int dst = pkt->dst ();
377		551
378	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."),
379	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst (), pkt->len);	553	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst (), pkt->len);
380		554
381	if (src == 0 \|\| src > conns.size ()	555	if (src == 0 \|\| src > conns.size ()
382	\|\| dst > conns.size ()	556	\|\| dst > conns.size ()
383	\|\| pkt->typ () >= vpn_packet::PT_MAX)	557	\|\| pkt->typ () >= vpn_packet::PT_MAX)
384	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)."),
385	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
386	else if (dst > conns.size ())
387	slog (L_WARN, _("(%s): received corrupted packet type %d (src %d, dst %d)"),
388	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());	559	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
389	else	560	else
390	{	561	{
391	connection *c = conns[src - 1];	562	connection *c = conns[src - 1];
392		563
393	if (dst == 0)	564	if (dst == 0)
394	slog (L_WARN, _("%s(%s): received broadcast (protocol violation)"),	565	slog (L_WARN, _("%s(%s): received broadcast (protocol violation)."),
395	c->conf->nodename, (const char *)rsi);	566	c->conf->nodename, (const char *)rsi);
396	else if (dst != THISNODE->id)	567	else if (dst != THISNODE->id)
397	{	568	{
398	if (THISNODE->routerprio)	569	if (THISNODE->routerprio)
399	// the tos setting gets lost here. who cares.	570	// the tos setting gets lost here. who cares.
400	conns[dst - 1]->inject_vpn_packet (pkt);	571	conns[dst - 1]->inject_vpn_packet (pkt);
401	else	572	else
402	slog (L_WARN,	573	slog (L_WARN,
403	_("%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?)."),
404	c->conf->nodename, (const char *)rsi,	575	c->conf->nodename, (const char *)rsi,
405	conns[dst - 1]->conf->nodename);	576	conns[dst - 1]->conf->nodename);
406	}	577	}
407	else	578	else
408	c->recv_vpn_packet (pkt, rsi);	579	c->recv_vpn_packet (pkt, rsi);
…		…
413	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)
414	{	585	{
415	switch (si.prot)	586	switch (si.prot)
416	{	587	{
417	case PROT_IPv4:	588	case PROT_IPv4:
418	return send_ipv4_packet (pkt, si, tos);	589	return send_ipv4_packet (pkt, si, tos);
		590
419	case PROT_UDPv4:	591	case PROT_UDPv4:
420	return send_udpv4_packet (pkt, si, tos);	592	return send_udpv4_packet (pkt, si, tos);
		593
421	#if ENABLE_TCP	594	#if ENABLE_TCP
422	case PROT_TCPv4:	595	case PROT_TCPv4:
423	return send_tcpv4_packet (pkt, si, tos);	596	return send_tcpv4_packet (pkt, si, tos);
424	#endif	597	#endif
425	#if ENABLE_ICMP	598	#if ENABLE_ICMP
426	case PROT_ICMPv4:	599	case PROT_ICMPv4:
427	return send_icmpv4_packet (pkt, si, tos);	600	return send_icmpv4_packet (pkt, si, tos);
428	#endif	601	#endif
429	#if ENABLE_DNS	602	#if ENABLE_DNS
430	case PROT_DNSv4:	603	case PROT_DNSv4:
431	return send_dnsv4_packet (pkt, si, tos);	604	return send_dnsv4_packet (pkt, si, tos);
432	#endif	605	#endif
433
434	default:	606	default:
435	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);
436	}	608	}
437		609
438	return false;	610	return false;
439	}	611	}
440		612
441	void	613	inline void
442	vpn::ipv4_ev (io_watcher &w, short revents)	614	vpn::ipv4_ev (ev::io &w, int revents)
443	{	615	{
444	if (revents & EVENT_READ)	616	if (revents & EV_READ)
445	{	617	{
446	vpn_packet *pkt = new vpn_packet;	618	vpn_packet *pkt = new vpn_packet;
447	struct sockaddr_in sa;	619	struct sockaddr_in sa;
448	socklen_t sa_len = sizeof (sa);	620	socklen_t sa_len = sizeof (sa);
449	int len;	621	int len;
…		…
455	if (len > 0)	627	if (len > 0)
456	{	628	{
457	pkt->len = len;	629	pkt->len = len;
458		630
459	// 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
460	pkt->skip_hdr (IP_OVERHEAD);	632	pkt->skip_hdr (pkt->ipv4_hdr_len ());
461		633
462	recv_vpn_packet (pkt, si);	634	recv_vpn_packet (pkt, si);
463	}	635	}
464	else	636	else
465	{	637	{
466	// probably ECONNRESET or somesuch	638	// probably ECONNRESET or somesuch
467	slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));	639	slog (L_DEBUG, _("%s: %s."), (const char *)si, strerror (errno));
468	}	640	}
469		641
470	delete pkt;	642	delete pkt;
471	}	643	}
472	else	644	else
473	{	645	{
474	slog (L_ERR,	646	slog (L_ERR,
475	_("FATAL: unknown revents %08x in socket, terminating\n"),	647	_("FATAL: unknown revents %08x in socket, exiting.\n"),
476	revents);	648	revents);
477	exit (EXIT_FAILURE);	649	exit (EXIT_FAILURE);
478	}	650	}
479	}	651	}
480		652
481	#if ENABLE_ICMP	653	#if ENABLE_ICMP
482	void	654	inline void
483	vpn::icmpv4_ev (io_watcher &w, short revents)	655	vpn::icmpv4_ev (ev::io &w, int revents)
484	{	656	{
485	if (revents & EVENT_READ)	657	if (revents & EV_READ)
486	{	658	{
487	vpn_packet *pkt = new vpn_packet;	659	vpn_packet *pkt = new vpn_packet;
488	struct sockaddr_in sa;	660	struct sockaddr_in sa;
489	socklen_t sa_len = sizeof (sa);	661	socklen_t sa_len = sizeof (sa);
490	int len;	662	int len;
…		…
502	if (hdr->type == ::conf.icmp_type	674	if (hdr->type == ::conf.icmp_type
503	&& hdr->code == 255)	675	&& hdr->code == 255)
504	{	676	{
505	// 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
506	// this is slow, but...	678	// this is slow, but...
507	pkt->skip_hdr (ICMP_OVERHEAD);	679	pkt->skip_hdr (pkt->ipv4_hdr_len () + (ICMP_OVERHEAD - IP_OVERHEAD));
508		680
509	recv_vpn_packet (pkt, si);	681	recv_vpn_packet (pkt, si);
510	}	682	}
511	}	683	}
512	else	684	else
513	{	685	{
514	// probably ECONNRESET or somesuch	686	// probably ECONNRESET or somesuch
515	slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));	687	slog (L_DEBUG, _("%s: %s."), (const char *)si, strerror (errno));
516	}	688	}
517		689
518	delete pkt;	690	delete pkt;
519	}	691	}
520	else	692	else
521	{	693	{
522	slog (L_ERR,	694	slog (L_ERR,
523	_("FATAL: unknown revents %08x in socket, terminating\n"),	695	_("FATAL: unknown revents %08x in socket, exiting.\n"),
524	revents);	696	revents);
525	exit (EXIT_FAILURE);	697	exit (EXIT_FAILURE);
526	}	698	}
527	}	699	}
528	#endif	700	#endif
529		701
530	void	702	inline void
531	vpn::udpv4_ev (io_watcher &w, short revents)	703	vpn::udpv4_ev (ev::io &w, int revents)
532	{	704	{
533	if (revents & EVENT_READ)	705	if (revents & EV_READ)
534	{	706	{
535	vpn_packet *pkt = new vpn_packet;	707	vpn_packet *pkt = new vpn_packet;
536	struct sockaddr_in sa;	708	struct sockaddr_in sa;
537	socklen_t sa_len = sizeof (sa);	709	socklen_t sa_len = sizeof (sa);
538	int len;	710	int len;
…		…
548	recv_vpn_packet (pkt, si);	720	recv_vpn_packet (pkt, si);
549	}	721	}
550	else	722	else
551	{	723	{
552	// probably ECONNRESET or somesuch	724	// probably ECONNRESET or somesuch
553	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));
554	}	726	}
555		727
556	delete pkt;	728	delete pkt;
557	}	729	}
558	else	730	else
559	{	731	{
560	slog (L_ERR,	732	slog (L_ERR,
561	_("FATAL: unknown revents %08x in socket, terminating\n"),	733	_("FATAL: unknown revents %08x in socket, exiting.\n"),
562	revents);	734	revents);
563	exit (EXIT_FAILURE);	735	exit (EXIT_FAILURE);
564	}	736	}
565	}	737	}
566		738
567	void	739	inline void
568	vpn::tap_ev (io_watcher &w, short revents)	740	vpn::tap_ev (ev::io &w, int revents)
569	{	741	{
570	if (revents & EVENT_READ)	742	if (revents & EV_READ)
571	{	743	{
572	/* process data */	744	/* process data */
573	tap_packet *pkt;	745	tap_packet *pkt;
574		746
575	pkt = tap->recv ();	747	pkt = tap->recv ();
…		…
604	}	776	}
605	else	777	else
606	abort ();	778	abort ();
607	}	779	}
608		780
609	void	781	inline void
610	vpn::event_cb (time_watcher &w)	782	vpn::event_cb (ev::timer &w, int)
611	{	783	{
612	if (events)	784	if (events)
613	{	785	{
614	if (events & EVENT_SHUTDOWN)	786	if (events & EVENT_SHUTDOWN)
615	{	787	{
616	slog (L_INFO, _("preparing shutdown..."));	788	slog (L_INFO, _("preparing shutdown..."));
617		789
618	shutdown_all ();	790	shutdown_all ();
619	remove_pid (conf.pidfilename);	791	remove_pid (conf.pidfilename);
620	slog (L_INFO, _("terminating"));	792	slog (L_INFO, _("exiting."));
621	exit (EXIT_SUCCESS);	793	exit (EXIT_SUCCESS);
622	}	794	}
623		795
624	if (events & EVENT_RECONNECT)	796	if (events & EVENT_RECONNECT)
625	{	797	{
626	slog (L_INFO, _("forced reconnect"));	798	slog (L_INFO, _("forced reconnect."));
627		799
628	reconnect_all ();	800	reconnect_all ();
629	}	801	}
630		802
631	events = 0;	803	events = 0;
…		…
647		819
648	conns.clear ();	820	conns.clear ();
649		821
650	connection_init ();	822	connection_init ();
651		823
652	for (configuration::node_vector::iterator i = conf.nodes.begin ();	824	for (configuration::node_vector::iterator i = conf.nodes.begin (); i != conf.nodes.end (); ++i)
653	i != conf.nodes.end (); ++i)	825	conns.push_back (new connection (this, *i));
654	{	826
655	connection conn = new connection (this, i);	827	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
656	conns.push_back (conn);
657	conn->establish_connection ();	828	(*c)->establish_connection ();
658	}
659	}	829	}
660		830
661	connection *vpn::find_router ()	831	bool
		832	vpn::can_direct (conf_node src, conf_node dst) const
662	{	833	{
663	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	{
664	connection *router = 0;	846	connection *router = 0;
665		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	{
666	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)	896	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
667	{	897	{
668	connection c = i;	898	connection o = i;
669		899
670	if (c->conf->routerprio > prio	900	if (!o->is_direct
671	&& c->connectmode == conf_node::C_ALWAYS // so we don't drop the connection if in use	901	&& o->si.valid ()
672	&& c->ictx && c->octx	902	&& c->si != o->si
673	&& c->conf != THISNODE) // redundant, since ictx==octx==0 always on thisnode	903	&& c == find_router_for (o))
674	{
675	prio = c->conf->routerprio;
676	router = c;
677	}	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	}
678	}	909	}
679
680	return router;
681	}	910	}
682		911
		912	void
683	void vpn::send_connect_request (int id)	913	vpn::send_connect_request (connection *c)
684	{	914	{
685	connection *c = find_router ();	915	connection *r = find_router_for (c);
686		916
687	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);
688	c->send_connect_request (id);	921	r->send_connect_request (c->conf->id);
		922	}
689	else	923	else
690	// 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."),
691	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)	925	c->conf->nodename);
692	if ((i)->conf->routerprio && (i)->conf != THISNODE)
693	(*i)->establish_connection ();
694	}	926	}
695		927
696	void	928	void
697	connection::dump_status ()	929	connection::dump_status ()
698	{	930	{
699	slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);	931	slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);
700	slog (L_NOTICE, _(" connectmode %d (%d) / sockaddr %s / minor %d"),	932	slog (L_NOTICE, _(" connectmode %d (%d) / sockaddr %s / minor %d"),
701	connectmode, conf->connectmode, (const char *)si, (int)prot_minor);	933	connectmode, conf->connectmode, (const char *)si, (int)prot_minor);
702	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"),
703	(long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);	935	(long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);
704	slog (L_NOTICE, _(" establish_conn %ld / rekey %ld / keepalive %ld"),
705	(long)(establish_connection.at), (long)(rekey.at), (long)(keepalive.at));
706	}	936	}
707		937
708	void	938	void
709	vpn::dump_status ()	939	vpn::dump_status ()
710	{	940	{
711	slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)NOW);	941	slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)ev_now ());
712		942
713	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)	943	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
714	(*c)->dump_status ();	944	(*c)->dump_status ();
715		945
716	slog (L_NOTICE, _("END status dump"));	946	slog (L_NOTICE, _("END status dump"));
717	}	947	}
718		948
719	vpn::vpn (void)	949	vpn::vpn (void)
		950	{
720	: event (this, &vpn::event_cb)	951	event .set<vpn, &vpn::event_cb > (this);
721	, udpv4_ev_watcher (this, &vpn::udpv4_ev)	952	udpv4_ev_watcher .set<vpn, &vpn::udpv4_ev > (this);
722	, ipv4_ev_watcher (this, &vpn::ipv4_ev)	953	ipv4_ev_watcher .set<vpn, &vpn::ipv4_ev > (this);
723	#if ENABLE_TCP	954	#if ENABLE_TCP
724	, tcpv4_ev_watcher (this, &vpn::tcpv4_ev)	955	tcpv4_ev_watcher .set<vpn, &vpn::tcpv4_ev > (this);
725	#endif	956	#endif
726	#if ENABLE_ICMP	957	#if ENABLE_ICMP
727	, icmpv4_ev_watcher(this, &vpn::icmpv4_ev)	958	icmpv4_ev_watcher.set<vpn, &vpn::icmpv4_ev> (this);
728	#endif	959	#endif
729	#if ENABLE_DNS	960	#if ENABLE_DNS
730	, dnsv4_ev_watcher (this, &vpn::dnsv4_ev)	961	dnsv4_ev_watcher .set<vpn, &vpn::dnsv4_ev > (this);
731	#endif	962	#endif
732	, tap_ev_watcher (this, &vpn::tap_ev)	963	tap_ev_watcher .set<vpn, &vpn::tap_ev > (this);
733	{
734	}	964	}
735		965
736	vpn::~vpn ()	966	vpn::~vpn ()
737	{	967	{
738	}	968	}

Diff Legend

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

Comparing gvpe/src/vpn.C (file contents): Revision 1.32 by pcg, Mon Mar 7 01:31:26 2005 UTC vs. Revision 1.64 by root, Tue Dec 4 10:29:43 2012 UTC

Diff Legend

Comparing gvpe/src/vpn.C (file contents):
Revision 1.32 by pcg, Mon Mar 7 01:31:26 2005 UTC vs.
Revision 1.64 by root, Tue Dec 4 10:29:43 2012 UTC