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

Comparing gvpe/src/vpn.C (file contents):
Revision 1.31 by pcg, Sat Mar 5 19:13:16 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;
		323
		324	# if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
		325	// this I really consider a linux bug. I am neither connected
		326	// nor do I fragment myself. Linux still sets DF and doesn't
		327	// fragment for me sometimes.
		328	{
		329	int oval = IP_PMTUDISC_DONT;
		330	setsockopt (dnsv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
		331	}
		332	# endif
239		333
240	// standard daemon practise...	334	// standard daemon practise...
241	{	335	{
242	int oval = 1;	336	int oval = 1;
243	setsockopt (dnsv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);	337	setsockopt (dnsv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
…		…
247	THISNODE->dns_hostname ? THISNODE->dns_port : 0,	341	THISNODE->dns_hostname ? THISNODE->dns_port : 0,
248	PROT_DNSv4);	342	PROT_DNSv4);
249		343
250	if (bind (dnsv4_fd, si.sav4 (), si.salenv4 ()))	344	if (bind (dnsv4_fd, si.sav4 (), si.salenv4 ()))
251	{	345	{
252	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));
253	exit (EXIT_FAILURE);	347	return -1;
254	}	348	}
255		349
256	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)
257	}	358	{
258	#endif	359	slog (L_ERR, _("no protocols enabled."));
		360	return -1;
		361	}
		362
		363	reconnect_all ();
		364
		365	/////////////////////////////////////////////////////////////////////////////
259		366
260	tap = new tap_device ();	367	tap = new tap_device ();
261	if (!tap) //D this, of course, never catches	368	if (!tap) //D this, of course, never catches
262	{	369	{
263	slog (L_ERR, _("cannot create network interface '%s'"), conf.ifname);	370	slog (L_ERR, _("cannot create network interface '%s'."), conf.ifname);
264	exit (EXIT_FAILURE);	371	return -1;
265	}	372	}
266		373
267	run_script (run_script_cb (this, &vpn::script_if_up), true);	374	fcntl (tap->fd, F_SETFD, FD_CLOEXEC);
268		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
269	tap_ev_watcher.start (tap->fd, EVENT_READ);	394	tap_ev_watcher.start (tap->fd, EV_READ);
270
271	reconnect_all ();
272		395
273	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;
274	}	465	}
275		466
276	bool	467	bool
277	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)
278	{	469	{
279	#if defined(SOL_IP) && defined(IP_TOS)	470	set_tos (ipv4_fd, ipv4_tos, tos);
280	setsockopt (ipv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
281	#endif
282	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 ());
283		472
284	return true;	473	return true;
285	}	474	}
286		475
…		…
309		498
310	#if ENABLE_ICMP	499	#if ENABLE_ICMP
311	bool	500	bool
312	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)
313	{	502	{
314	#if defined(SOL_IP) && defined(IP_TOS)
315	setsockopt (icmpv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
316	#endif
317
318	pkt->unshift_hdr (4);	503	pkt->unshift_hdr (4);
319		504
320	icmp_header hdr = (icmp_header )&((*pkt)[0]);	505	icmp_header hdr = (icmp_header )&((*pkt)[0]);
321	hdr->type = ::conf.icmp_type;	506	hdr->type = ::conf.icmp_type;
322	hdr->code = 255;	507	hdr->code = 255;
323	hdr->checksum = 0;	508	hdr->checksum = 0;
324	hdr->checksum = ipv4_checksum ((u16 *)hdr, pkt->len);	509	hdr->checksum = ipv4_checksum ((u16 *)hdr, pkt->len);
325		510
		511	set_tos (icmpv4_fd, icmpv4_tos, tos);
326	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 ());
327		513
328	return true;	514	return true;
329	}	515	}
330	#endif	516	#endif
331		517
332	bool	518	bool
333	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)
334	{	520	{
335	#if defined(SOL_IP) && defined(IP_TOS)	521	set_tos (udpv4_fd, udpv4_tos, tos);
336	setsockopt (udpv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
337	#endif
338	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 ());
339		523
340	return true;	524	return true;
341	}	525	}
342		526
…		…
353	{	537	{
354	// broadcast, this is ugly, but due to the security policy	538	// broadcast, this is ugly, but due to the security policy
355	// we have to connect to all hosts...	539	// we have to connect to all hosts...
356	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)	540	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
357	if ((*c)->conf != THISNODE)	541	if ((*c)->conf != THISNODE)
358	(*c)->inject_data_packet (pkt, true);	542	(*c)->inject_data_packet (pkt);
359	}	543	}
360	}	544	}
361		545
362	void	546	void
363	vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)	547	vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)
364	{	548	{
365	unsigned int src = pkt->src ();	549	unsigned int src = pkt->src ();
366	unsigned int dst = pkt->dst ();	550	unsigned int dst = pkt->dst ();
367		551
368	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."),
369	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst (), pkt->len);	553	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst (), pkt->len);
370		554
371	if (src == 0 \|\| src > conns.size ()	555	if (src == 0 \|\| src > conns.size ()
372	\|\| dst > conns.size ()	556	\|\| dst > conns.size ()
373	\|\| pkt->typ () >= vpn_packet::PT_MAX)	557	\|\| pkt->typ () >= vpn_packet::PT_MAX)
374	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)."),
375	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
376	else if (dst > conns.size ())
377	slog (L_WARN, _("(%s): received corrupted packet type %d (src %d, dst %d)"),
378	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());	559	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
379	else	560	else
380	{	561	{
381	connection *c = conns[src - 1];	562	connection *c = conns[src - 1];
382		563
383	if (dst == 0)	564	if (dst == 0)
384	slog (L_WARN, _("%s(%s): received broadcast (protocol violation)"),	565	slog (L_WARN, _("%s(%s): received broadcast (protocol violation)."),
385	c->conf->nodename, (const char *)rsi);	566	c->conf->nodename, (const char *)rsi);
386	else if (dst != THISNODE->id)	567	else if (dst != THISNODE->id)
387	{	568	{
388	if (THISNODE->routerprio)	569	if (THISNODE->routerprio)
389	// the tos setting gets lost here. who cares.	570	// the tos setting gets lost here. who cares.
390	conns[dst - 1]->inject_vpn_packet (pkt);	571	conns[dst - 1]->inject_vpn_packet (pkt);
391	else	572	else
392	slog (L_WARN,	573	slog (L_WARN,
393	_("%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?)."),
394	c->conf->nodename, (const char *)rsi,	575	c->conf->nodename, (const char *)rsi,
395	conns[dst - 1]->conf->nodename);	576	conns[dst - 1]->conf->nodename);
396	}	577	}
397	else	578	else
398	c->recv_vpn_packet (pkt, rsi);	579	c->recv_vpn_packet (pkt, rsi);
…		…
403	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)
404	{	585	{
405	switch (si.prot)	586	switch (si.prot)
406	{	587	{
407	case PROT_IPv4:	588	case PROT_IPv4:
408	return send_ipv4_packet (pkt, si, tos);	589	return send_ipv4_packet (pkt, si, tos);
		590
409	case PROT_UDPv4:	591	case PROT_UDPv4:
410	return send_udpv4_packet (pkt, si, tos);	592	return send_udpv4_packet (pkt, si, tos);
		593
411	#if ENABLE_TCP	594	#if ENABLE_TCP
412	case PROT_TCPv4:	595	case PROT_TCPv4:
413	return send_tcpv4_packet (pkt, si, tos);	596	return send_tcpv4_packet (pkt, si, tos);
414	#endif	597	#endif
415	#if ENABLE_ICMP	598	#if ENABLE_ICMP
416	case PROT_ICMPv4:	599	case PROT_ICMPv4:
417	return send_icmpv4_packet (pkt, si, tos);	600	return send_icmpv4_packet (pkt, si, tos);
418	#endif	601	#endif
419	#if ENABLE_DNS	602	#if ENABLE_DNS
420	case PROT_DNSv4:	603	case PROT_DNSv4:
421	return send_dnsv4_packet (pkt, si, tos);	604	return send_dnsv4_packet (pkt, si, tos);
422	#endif	605	#endif
423
424	default:	606	default:
425	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);
426	}	608	}
427		609
428	return false;	610	return false;
429	}	611	}
430		612
431	void	613	inline void
432	vpn::ipv4_ev (io_watcher &w, short revents)	614	vpn::ipv4_ev (ev::io &w, int revents)
433	{	615	{
434	if (revents & EVENT_READ)	616	if (revents & EV_READ)
435	{	617	{
436	vpn_packet *pkt = new vpn_packet;	618	vpn_packet *pkt = new vpn_packet;
437	struct sockaddr_in sa;	619	struct sockaddr_in sa;
438	socklen_t sa_len = sizeof (sa);	620	socklen_t sa_len = sizeof (sa);
439	int len;	621	int len;
…		…
445	if (len > 0)	627	if (len > 0)
446	{	628	{
447	pkt->len = len;	629	pkt->len = len;
448		630
449	// 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
450	pkt->skip_hdr (IP_OVERHEAD);	632	pkt->skip_hdr (pkt->ipv4_hdr_len ());
451		633
452	recv_vpn_packet (pkt, si);	634	recv_vpn_packet (pkt, si);
453	}	635	}
454	else	636	else
455	{	637	{
456	// probably ECONNRESET or somesuch	638	// probably ECONNRESET or somesuch
457	slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));	639	slog (L_DEBUG, _("%s: %s."), (const char *)si, strerror (errno));
458	}	640	}
459		641
460	delete pkt;	642	delete pkt;
461	}	643	}
462	else	644	else
463	{	645	{
464	slog (L_ERR,	646	slog (L_ERR,
465	_("FATAL: unknown revents %08x in socket, terminating\n"),	647	_("FATAL: unknown revents %08x in socket, exiting.\n"),
466	revents);	648	revents);
467	exit (EXIT_FAILURE);	649	exit (EXIT_FAILURE);
468	}	650	}
469	}	651	}
470		652
471	#if ENABLE_ICMP	653	#if ENABLE_ICMP
472	void	654	inline void
473	vpn::icmpv4_ev (io_watcher &w, short revents)	655	vpn::icmpv4_ev (ev::io &w, int revents)
474	{	656	{
475	if (revents & EVENT_READ)	657	if (revents & EV_READ)
476	{	658	{
477	vpn_packet *pkt = new vpn_packet;	659	vpn_packet *pkt = new vpn_packet;
478	struct sockaddr_in sa;	660	struct sockaddr_in sa;
479	socklen_t sa_len = sizeof (sa);	661	socklen_t sa_len = sizeof (sa);
480	int len;	662	int len;
…		…
492	if (hdr->type == ::conf.icmp_type	674	if (hdr->type == ::conf.icmp_type
493	&& hdr->code == 255)	675	&& hdr->code == 255)
494	{	676	{
495	// 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
496	// this is slow, but...	678	// this is slow, but...
497	pkt->skip_hdr (ICMP_OVERHEAD);	679	pkt->skip_hdr (pkt->ipv4_hdr_len () + (ICMP_OVERHEAD - IP_OVERHEAD));
498		680
499	recv_vpn_packet (pkt, si);	681	recv_vpn_packet (pkt, si);
500	}	682	}
501	}	683	}
502	else	684	else
503	{	685	{
504	// probably ECONNRESET or somesuch	686	// probably ECONNRESET or somesuch
505	slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));	687	slog (L_DEBUG, _("%s: %s."), (const char *)si, strerror (errno));
506	}	688	}
507		689
508	delete pkt;	690	delete pkt;
509	}	691	}
510	else	692	else
511	{	693	{
512	slog (L_ERR,	694	slog (L_ERR,
513	_("FATAL: unknown revents %08x in socket, terminating\n"),	695	_("FATAL: unknown revents %08x in socket, exiting.\n"),
514	revents);	696	revents);
515	exit (EXIT_FAILURE);	697	exit (EXIT_FAILURE);
516	}	698	}
517	}	699	}
518	#endif	700	#endif
519		701
520	void	702	inline void
521	vpn::udpv4_ev (io_watcher &w, short revents)	703	vpn::udpv4_ev (ev::io &w, int revents)
522	{	704	{
523	if (revents & EVENT_READ)	705	if (revents & EV_READ)
524	{	706	{
525	vpn_packet *pkt = new vpn_packet;	707	vpn_packet *pkt = new vpn_packet;
526	struct sockaddr_in sa;	708	struct sockaddr_in sa;
527	socklen_t sa_len = sizeof (sa);	709	socklen_t sa_len = sizeof (sa);
528	int len;	710	int len;
…		…
538	recv_vpn_packet (pkt, si);	720	recv_vpn_packet (pkt, si);
539	}	721	}
540	else	722	else
541	{	723	{
542	// probably ECONNRESET or somesuch	724	// probably ECONNRESET or somesuch
543	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));
544	}	726	}
545		727
546	delete pkt;	728	delete pkt;
547	}	729	}
548	else	730	else
549	{	731	{
550	slog (L_ERR,	732	slog (L_ERR,
551	_("FATAL: unknown revents %08x in socket, terminating\n"),	733	_("FATAL: unknown revents %08x in socket, exiting.\n"),
552	revents);	734	revents);
553	exit (EXIT_FAILURE);	735	exit (EXIT_FAILURE);
554	}	736	}
555	}	737	}
556		738
557	void	739	inline void
558	vpn::tap_ev (io_watcher &w, short revents)	740	vpn::tap_ev (ev::io &w, int revents)
559	{	741	{
560	if (revents & EVENT_READ)	742	if (revents & EV_READ)
561	{	743	{
562	/* process data */	744	/* process data */
563	tap_packet *pkt;	745	tap_packet *pkt;
564		746
565	pkt = tap->recv ();	747	pkt = tap->recv ();
…		…
594	}	776	}
595	else	777	else
596	abort ();	778	abort ();
597	}	779	}
598		780
599	void	781	inline void
600	vpn::event_cb (time_watcher &w)	782	vpn::event_cb (ev::timer &w, int)
601	{	783	{
602	if (events)	784	if (events)
603	{	785	{
604	if (events & EVENT_SHUTDOWN)	786	if (events & EVENT_SHUTDOWN)
605	{	787	{
606	slog (L_INFO, _("preparing shutdown..."));	788	slog (L_INFO, _("preparing shutdown..."));
607		789
608	shutdown_all ();	790	shutdown_all ();
609	remove_pid (conf.pidfilename);	791	remove_pid (conf.pidfilename);
610	slog (L_INFO, _("terminating"));	792	slog (L_INFO, _("exiting."));
611	exit (EXIT_SUCCESS);	793	exit (EXIT_SUCCESS);
612	}	794	}
613		795
614	if (events & EVENT_RECONNECT)	796	if (events & EVENT_RECONNECT)
615	{	797	{
616	slog (L_INFO, _("forced reconnect"));	798	slog (L_INFO, _("forced reconnect."));
617		799
618	reconnect_all ();	800	reconnect_all ();
619	}	801	}
620		802
621	events = 0;	803	events = 0;
…		…
637		819
638	conns.clear ();	820	conns.clear ();
639		821
640	connection_init ();	822	connection_init ();
641		823
642	for (configuration::node_vector::iterator i = conf.nodes.begin ();	824	for (configuration::node_vector::iterator i = conf.nodes.begin (); i != conf.nodes.end (); ++i)
643	i != conf.nodes.end (); ++i)	825	conns.push_back (new connection (this, *i));
644	{	826
645	connection conn = new connection (this, i);	827	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
646	conns.push_back (conn);
647	conn->establish_connection ();	828	(*c)->establish_connection ();
648	}
649	}	829	}
650		830
651	connection *vpn::find_router ()	831	bool
		832	vpn::can_direct (conf_node src, conf_node dst) const
652	{	833	{
653	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	{
654	connection *router = 0;	846	connection *router = 0;
655		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	{
656	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)	896	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
657	{	897	{
658	connection c = i;	898	connection o = i;
659		899
660	if (c->conf->routerprio > prio	900	if (!o->is_direct
661	&& c->connectmode == conf_node::C_ALWAYS // so we don't drop the connection if in use	901	&& o->si.valid ()
662	&& c->ictx && c->octx	902	&& c->si != o->si
663	&& c->conf != THISNODE) // redundant, since ictx==octx==0 always on thisnode	903	&& c == find_router_for (o))
664	{
665	prio = c->conf->routerprio;
666	router = c;
667	}	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	}
668	}	909	}
669
670	return router;
671	}	910	}
672		911
		912	void
673	void vpn::send_connect_request (int id)	913	vpn::send_connect_request (connection *c)
674	{	914	{
675	connection *c = find_router ();	915	connection *r = find_router_for (c);
676		916
677	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);
678	c->send_connect_request (id);	921	r->send_connect_request (c->conf->id);
		922	}
679	else	923	else
680	// 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."),
681	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)	925	c->conf->nodename);
682	if ((i)->conf->routerprio && (i)->conf != THISNODE)
683	(*i)->establish_connection ();
684	}	926	}
685		927
686	void	928	void
687	connection::dump_status ()	929	connection::dump_status ()
688	{	930	{
689	slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);	931	slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);
690	slog (L_NOTICE, _(" connectmode %d (%d) / sockaddr %s / minor %d"),	932	slog (L_NOTICE, _(" connectmode %d (%d) / sockaddr %s / minor %d"),
691	connectmode, conf->connectmode, (const char *)si, (int)prot_minor);	933	connectmode, conf->connectmode, (const char *)si, (int)prot_minor);
692	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"),
693	(long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);	935	(long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);
694	slog (L_NOTICE, _(" establish_conn %ld / rekey %ld / keepalive %ld"),
695	(long)(establish_connection.at), (long)(rekey.at), (long)(keepalive.at));
696	}	936	}
697		937
698	void	938	void
699	vpn::dump_status ()	939	vpn::dump_status ()
700	{	940	{
701	slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)NOW);	941	slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)ev_now ());
702		942
703	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)	943	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
704	(*c)->dump_status ();	944	(*c)->dump_status ();
705		945
706	slog (L_NOTICE, _("END status dump"));	946	slog (L_NOTICE, _("END status dump"));
707	}	947	}
708		948
709	vpn::vpn (void)	949	vpn::vpn (void)
		950	{
710	: event (this, &vpn::event_cb)	951	event .set<vpn, &vpn::event_cb > (this);
711	, udpv4_ev_watcher (this, &vpn::udpv4_ev)	952	udpv4_ev_watcher .set<vpn, &vpn::udpv4_ev > (this);
712	, ipv4_ev_watcher (this, &vpn::ipv4_ev)	953	ipv4_ev_watcher .set<vpn, &vpn::ipv4_ev > (this);
713	#if ENABLE_TCP	954	#if ENABLE_TCP
714	, tcpv4_ev_watcher (this, &vpn::tcpv4_ev)	955	tcpv4_ev_watcher .set<vpn, &vpn::tcpv4_ev > (this);
715	#endif	956	#endif
716	#if ENABLE_ICMP	957	#if ENABLE_ICMP
717	, icmpv4_ev_watcher(this, &vpn::icmpv4_ev)	958	icmpv4_ev_watcher.set<vpn, &vpn::icmpv4_ev> (this);
718	#endif	959	#endif
719	#if ENABLE_DNS	960	#if ENABLE_DNS
720	, dnsv4_ev_watcher (this, &vpn::dnsv4_ev)	961	dnsv4_ev_watcher .set<vpn, &vpn::dnsv4_ev > (this);
721	#endif	962	#endif
722	, tap_ev_watcher (this, &vpn::tap_ev)	963	tap_ev_watcher .set<vpn, &vpn::tap_ev > (this);
723	{
724	}	964	}
725		965
726	vpn::~vpn ()	966	vpn::~vpn ()
727	{	967	{
728	}	968	}

Diff Legend

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

Comparing gvpe/src/vpn.C (file contents): Revision 1.31 by pcg, Sat Mar 5 19:13:16 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.31 by pcg, Sat Mar 5 19:13:16 2005 UTC vs.
Revision 1.64 by root, Tue Dec 4 10:29:43 2012 UTC