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

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

Diff Legend

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

Comparing gvpe/src/vpn.C (file contents): Revision 1.39 by pcg, Sat Nov 10 05:14:22 2007 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.39 by pcg, Sat Nov 10 05:14:22 2007 UTC vs.
Revision 1.64 by root, Tue Dec 4 10:29:43 2012 UTC