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

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.67 by root, Fri Oct 11 04:07:24 2013 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.67 by root, Fri Oct 11 04:07:24 2013 UTC