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

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

Diff Legend

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

Comparing gvpe/src/vpn.C (file contents): Revision 1.30 by pcg, Fri Mar 4 20:26:50 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.30 by pcg, Fri Mar 4 20:26:50 2005 UTC vs.
Revision 1.64 by root, Tue Dec 4 10:29:43 2012 UTC