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

Comparing gvpe/src/vpn.C (file contents):
Revision 1.1 by pcg, Wed Apr 2 03:25:17 2003 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-2008,2010,2011 Marc Lehmann <gvpe@schmorp.de>
3		4
		5	This file is part of GVPE.
		6
4	This program is free software; you can redistribute it and/or modify	7	GVPE is free software; you can redistribute it and/or modify it
5	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
6	the Free Software Foundation; either version 2 of the License, or	9	Free Software Foundation; either version 3 of the License, or (at your
7	(at your option) any later version.	10	option) any later version.
8		11
9	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
10	but WITHOUT ANY WARRANTY; without even the implied warranty of	13	WITHOUT ANY WARRANTY; without even the implied warranty of
11	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the	14	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General
12	GNU General Public License for more details.	15	Public License for more details.
13		16
14	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
15	along with this program; if not, write to the Free Software	18	with this program; if not, see <http://www.gnu.org/licenses/>.
16	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.
17	*/	30	*/
18		31
19	#include "config.h"	32	#include "config.h"
20		33
21	#include <list>	34	#include <list>
22		35
		36	#include <cstdio>
		37	#include <cstring>
23	#include <cstdlib>	38	#include <cstdlib>
24	#include <cstring>
25	#include <cstdio>
26		39
27	#include <sys/types.h>	40	#include <sys/types.h>
28	#include <sys/socket.h>	41	#include <sys/socket.h>
29	#include <sys/poll.h>
30	#include <sys/wait.h>	42	#include <sys/wait.h>
31	#include <netinet/in.h>	43	#include <sys/stat.h>
32	#include <arpa/inet.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>
		47	#include <fcntl.h>
		48	#include <sys/socket.h>
		49
		50	#include "netcompat.h"
36		51
37	#include "pidfile.h"	52	#include "pidfile.h"
38		53
39	#include "connection.h"	54	#include "connection.h"
40	#include "util.h"	55	#include "util.h"
41	#include "vpn.h"	56	#include "vpn.h"
42		57
		58	using namespace std;
		59
		60	vpn network; // THE vpn (bad design...)
		61
43	/////////////////////////////////////////////////////////////////////////////	62	/////////////////////////////////////////////////////////////////////////////
44		63
45	const char *vpn::script_if_up (int)	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 ()
46	{	78	{
47	// the tunnel device mtu should be the physical mtu - overhead	79	// the tunnel device mtu should be the physical mtu - overhead
48	// the tricky part is rounding to the cipher key blocksize	80	// the tricky part is rounding to the cipher key blocksize
49	int mtu = conf.mtu - ETH_OVERHEAD - VPE_OVERHEAD - MAX_OVERHEAD;	81	int mtu = conf.mtu - ETH_OVERHEAD - VPE_OVERHEAD - MAX_OVERHEAD;
50	mtu += ETH_OVERHEAD - 6 - 6; // now we have the data portion	82	mtu += ETH_OVERHEAD - 6 - 6; // now we have the data portion
51	mtu -= mtu % EVP_CIPHER_block_size (CIPHER); // round	83	mtu -= mtu % EVP_CIPHER_block_size (CIPHER); // round
52	mtu -= ETH_OVERHEAD - 6 - 6; // and get interface mtu again	84	mtu -= ETH_OVERHEAD - 6 - 6; // and get interface mtu again
53		85
54	char *env;	86	char *env;
55	asprintf (&env, "CONFBASE=%s", confbase);	87	asprintf (&env, "CONFBASE=%s", confbase); putenv (env);
56	putenv (env);
57	asprintf (&env, "NODENAME=%s", THISNODE->nodename);
58	putenv (env);
59	asprintf (&env, "NODEID=%d", THISNODE->id);
60	putenv (env);
61	asprintf (&env, "IFNAME=%s", tap->interface ());	88	asprintf (&env, "IFNAME=%s", tap->interface ()); putenv (env);
62	putenv (env);	89	asprintf (&env, "IFTYPE=%s", IFTYPE); putenv (env);
		90	asprintf (&env, "IFSUBTYPE=%s", IFSUBTYPE); putenv (env);
63	asprintf (&env, "MTU=%d", mtu);	91	asprintf (&env, "MTU=%d", mtu); putenv (env);
64	putenv (env);	92	asprintf (&env, "NODES=%d", conns.size ()); putenv (env);
65	asprintf (&env, "MAC=%02x:%02x:%02x:%02x:%02x:%02x",	93	asprintf (&env, "NODEID=%d", THISNODE->id); putenv (env);
66	0xfe, 0xfd, 0x80, 0x00, THISNODE->id >> 8,
67	THISNODE->id & 0xff);
68	putenv (env);
69		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,
70	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;
71	}	148	}
72		149
73	int	150	int
74	vpn::setup ()	151	vpn::setup ()
75	{	152	{
76	sockinfo si;	153	int success = 0;
77		154
78	si.set (THISNODE);	155	ipv4_tos = -1;
79
80	udpv4_fd = -1;	156	ipv4_fd = -1;
81		157
82	if (THISNODE->protocols & PROT_UDPv4)	158	if (THISNODE->protocols & PROT_IPv4 && ::conf.ip_proto)
83	{	159	{
84	udpv4_fd = socket (PF_INET, SOCK_DGRAM, IPPROTO_UDP);	160	ipv4_fd = setup_socket (PROT_IPv4, PF_INET, SOCK_RAW, ::conf.ip_proto);
85		161
86	if (udpv4_fd < 0)	162	if (ipv4_fd < 0)
87	return -1;	163	return -1;
88		164
89	if (bind (udpv4_fd, si.sav4 (), si.salenv4 ()))	165	#if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
90	{
91	slog (L_ERR, _("can't bind udpv4 to %s: %s"), (const char *)si, strerror (errno));
92	exit (1);
93	}
94
95	#ifdef IP_MTU_DISCOVER
96	// this I really consider a linux bug. I am neither connected	166	// this I really consider a linux bug. I am neither connected
97	// 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
98	// fragment for me sometimes.	168	// fragment for me sometimes.
99	{	169	{
100	int oval = IP_PMTUDISC_DONT;	170	int oval = IP_PMTUDISC_DONT;
101	setsockopt (udpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);	171	setsockopt (ipv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
		172	}
		173	#endif
		174
		175	sockinfo si (THISNODE, PROT_IPv4);
		176
		177	if (bind (ipv4_fd, si.sav4 (), si.salenv4 ()))
		178	{
		179	slog (L_ERR, _("can't bind ipv4 socket on %s: %s, exiting."), (const char *)si, strerror (errno));
		180	return -1;
102	}	181	}
103	#endif	182
		183	ipv4_ev_watcher.start (ipv4_fd, EV_READ);
		184	++success;
		185	}
		186	else
		187	THISNODE->protocols &= ~PROT_IPv4;
		188
		189	udpv4_tos = -1;
		190	udpv4_fd = -1;
		191
		192	if (THISNODE->protocols & PROT_UDPv4 && THISNODE->udp_port)
		193	{
		194	udpv4_fd = setup_socket (PROT_UDPv4, PF_INET, SOCK_DGRAM, IPPROTO_UDP);
		195
		196	if (udpv4_fd < 0)
		197	return -1;
104		198
105	// standard daemon practise...	199	// standard daemon practise...
106	{	200	{
107	int oval = 1;	201	int oval = 1;
108	setsockopt (udpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);	202	setsockopt (udpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
109	}	203	}
110		204
111	udpv4_ev_watcher.start (udpv4_fd, POLLIN);	205	#if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
112	}
113
114	ipv4_fd = -1;
115	if (THISNODE->protocols & PROT_IPv4)
116	{
117	ipv4_fd = socket (PF_INET, SOCK_RAW, ::conf.ip_proto);
118
119	if (ipv4_fd < 0)
120	return -1;
121
122	if (bind (ipv4_fd, si.sav4 (), si.salenv4 ()))
123	{
124	slog (L_ERR, _("can't bind ipv4 socket to %s: %s"), (const char *)si, strerror (errno));
125	exit (1);
126	}
127
128	#ifdef IP_MTU_DISCOVER
129	// this I really consider a linux bug. I am neither connected	206	// this I really consider a linux bug. I am neither connected
130	// nor do I fragment myself. Linux still sets DF and doesn't	207	// nor do I fragment myself. Linux still sets DF and doesn't
131	// fragment for me sometimes.	208	// fragment for me sometimes.
132	{	209	{
133	int oval = IP_PMTUDISC_DONT;	210	int oval = IP_PMTUDISC_DONT;
		211	setsockopt (udpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
		212	}
		213	#endif
		214
		215	sockinfo si (THISNODE, PROT_UDPv4);
		216
		217	if (bind (udpv4_fd, si.sav4 (), si.salenv4 ()))
		218	{
		219	slog (L_ERR, _("can't bind udpv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
		220	return -1;
		221	}
		222
		223	udpv4_ev_watcher.start (udpv4_fd, EV_READ);
		224	++success;
		225	}
		226	else
		227	THISNODE->protocols &= ~PROT_UDPv4;
		228
		229	icmpv4_tos = -1;
		230	icmpv4_fd = -1;
		231
		232	#if ENABLE_ICMP
		233	if (THISNODE->protocols & PROT_ICMPv4)
		234	{
		235	icmpv4_fd = setup_socket (PROT_ICMPv4, PF_INET, SOCK_RAW, IPPROTO_ICMP);
		236
		237	if (icmpv4_fd < 0)
		238	return -1;
		239
		240	#ifdef ICMP_FILTER
		241	{
		242	icmp_filter oval;
		243	oval.data = 0xffffffff;
		244	if (::conf.icmp_type < 32)
		245	oval.data &= ~(1 << ::conf.icmp_type);
		246
		247	setsockopt (icmpv4_fd, SOL_RAW, ICMP_FILTER, &oval, sizeof oval);
		248	}
		249	#endif
		250
		251	#if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
		252	// this I really consider a linux bug. I am neither connected
		253	// nor do I fragment myself. Linux still sets DF and doesn't
		254	// fragment for me sometimes.
		255	{
		256	int oval = IP_PMTUDISC_DONT;
134	setsockopt (ipv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);	257	setsockopt (icmpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
		258	}
		259	#endif
		260
		261	sockinfo si (THISNODE, PROT_ICMPv4);
		262
		263	if (bind (icmpv4_fd, si.sav4 (), si.salenv4 ()))
		264	{
		265	slog (L_ERR, _("can't bind icmpv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
		266	return -1;
135	}	267	}
		268
		269	icmpv4_ev_watcher.start (icmpv4_fd, EV_READ);
		270	++success;
		271	}
		272	#endif
		273
		274	tcpv4_fd = -1;
		275
		276	#if ENABLE_TCP
		277	if (THISNODE->protocols & PROT_TCPv4 && THISNODE->tcp_port)
		278	{
		279	tcpv4_fd = setup_socket (PROT_TCPv4, PF_INET, SOCK_STREAM, IPPROTO_TCP);
		280
		281	if (tcpv4_fd < 0)
		282	return -1;
		283
		284	// standard daemon practise...
		285	{
		286	int oval = 1;
		287	setsockopt (tcpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
		288	}
		289
		290	sockinfo si (THISNODE, PROT_TCPv4);
		291
		292	if (bind (tcpv4_fd, si.sav4 (), si.salenv4 ()))
		293	{
		294	slog (L_ERR, _("can't bind tcpv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
		295	return -1;
		296	}
		297
		298	if (listen (tcpv4_fd, 5))
		299	{
		300	slog (L_ERR, _("can't listen tcpv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
		301	return -1;
		302	}
		303
		304	tcpv4_ev_watcher.start (tcpv4_fd, EV_READ);
		305	++success;
		306	}
		307	else
		308	THISNODE->protocols &= ~PROT_TCPv4;
		309	#endif
		310
		311	dnsv4_tos = -1;
		312	dnsv4_fd = -1;
		313
		314	#if ENABLE_DNS
		315	if (THISNODE->protocols & PROT_DNSv4)
		316	{
		317	dns_forwarder.set (::conf.dns_forw_host, ::conf.dns_forw_port, PROT_DNSv4);
		318
		319	dnsv4_fd = setup_socket (PROT_DNSv4, PF_INET, SOCK_DGRAM, IPPROTO_UDP);
		320
		321	if (dnsv4_fd < 0)
		322	return -1;
		323
		324	# if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
		325	// this I really consider a linux bug. I am neither connected
		326	// nor do I fragment myself. Linux still sets DF and doesn't
		327	// fragment for me sometimes.
		328	{
		329	int oval = IP_PMTUDISC_DONT;
		330	setsockopt (dnsv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
		331	}
136	#endif	332	# endif
137		333
138	ipv4_ev_watcher.start (ipv4_fd, POLLIN);	334	// standard daemon practise...
		335	{
		336	int oval = 1;
		337	setsockopt (dnsv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
139	}	338	}
		339
		340	sockinfo si (THISNODE->dns_hostname,
		341	THISNODE->dns_hostname ? THISNODE->dns_port : 0,
		342	PROT_DNSv4);
		343
		344	if (bind (dnsv4_fd, si.sav4 (), si.salenv4 ()))
		345	{
		346	slog (L_ERR, _("can't bind dnsv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
		347	return -1;
		348	}
		349
		350	dnsv4_ev_watcher.start (dnsv4_fd, EV_READ);
		351	++success;
		352	}
		353	#endif
		354
		355	/////////////////////////////////////////////////////////////////////////////
		356
		357	if (!success)
		358	{
		359	slog (L_ERR, _("no protocols enabled."));
		360	return -1;
		361	}
		362
		363	reconnect_all ();
		364
		365	/////////////////////////////////////////////////////////////////////////////
140		366
141	tap = new tap_device ();	367	tap = new tap_device ();
142	if (!tap) //D this, of course, never catches	368	if (!tap) //D this, of course, never catches
143	{	369	{
144	slog (L_ERR, _("cannot create network interface '%s'"), conf.ifname);	370	slog (L_ERR, _("cannot create network interface '%s'."), conf.ifname);
145	exit (1);	371	return -1;
146	}	372	}
147		373
148	run_script (run_script_cb (this, &vpn::script_if_up), true);	374	fcntl (tap->fd, F_SETFD, FD_CLOEXEC);
149		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
150	tap_ev_watcher.start (tap->fd, POLLIN);	394	tap_ev_watcher.start (tap->fd, EV_READ);
151
152	reconnect_all ();
153		395
154	return 0;	396	return 0;
155	}	397	}
156		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;
		465	}
		466
		467	bool
		468	vpn::send_ipv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
		469	{
		470	set_tos (ipv4_fd, ipv4_tos, tos);
		471	sendto (ipv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
		472
		473	return true;
		474	}
		475
		476	static u16
		477	ipv4_checksum (u16 *data, unsigned int len)
		478	{
		479	// use 32 bit accumulator and fold back carry bits at the end
		480	u32 sum = 0;
		481
		482	while (len > 1)
		483	{
		484	sum += *data++;
		485	len -= 2;
		486	}
		487
		488	// odd byte left?
		489	if (len)
		490	sum += (u8 )data;
		491
		492	// add back carry bits
		493	sum = (sum >> 16) + (sum & 0xffff); // lo += hi
		494	sum += (sum >> 16); // carry
		495
		496	return ~sum;
		497	}
		498
		499	#if ENABLE_ICMP
		500	bool
		501	vpn::send_icmpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
		502	{
		503	pkt->unshift_hdr (4);
		504
		505	icmp_header hdr = (icmp_header )&((*pkt)[0]);
		506	hdr->type = ::conf.icmp_type;
		507	hdr->code = 255;
		508	hdr->checksum = 0;
		509	hdr->checksum = ipv4_checksum ((u16 *)hdr, pkt->len);
		510
		511	set_tos (icmpv4_fd, icmpv4_tos, tos);
		512	sendto (icmpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
		513
		514	return true;
		515	}
		516	#endif
		517
		518	bool
		519	vpn::send_udpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
		520	{
		521	set_tos (udpv4_fd, udpv4_tos, tos);
		522	sendto (udpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
		523
		524	return true;
		525	}
		526
157	void	527	void
158	vpn::send_ipv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)	528	vpn::inject_data_packet (tap_packet *pkt, int dst)
159	{	529	{
160	setsockopt (ipv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);	530	if (dst)
161	sendto (ipv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());	531	{
162	}	532	// unicast
163		533	if (dst != THISNODE->id)
164	void	534	conns[dst - 1]->inject_data_packet (pkt);
165	vpn::send_udpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)	535	}
166	{	536	else
167	setsockopt (udpv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);	537	{
168	sendto (udpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());	538	// broadcast, this is ugly, but due to the security policy
		539	// we have to connect to all hosts...
		540	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
		541	if ((*c)->conf != THISNODE)
		542	(*c)->inject_data_packet (pkt);
		543	}
169	}	544	}
170		545
171	void	546	void
172	vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)	547	vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)
173	{	548	{
174	unsigned int src = pkt->src ();	549	unsigned int src = pkt->src ();
175	unsigned int dst = pkt->dst ();	550	unsigned int dst = pkt->dst ();
176		551
177	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."),
178	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst (), pkt->len);	553	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst (), pkt->len);
179		554
180	if (src == 0 \|\| src > conns.size ()	555	if (src == 0 \|\| src > conns.size ()
181	\|\| dst > conns.size ()	556	\|\| dst > conns.size ()
182	\|\| pkt->typ () >= vpn_packet::PT_MAX)	557	\|\| pkt->typ () >= vpn_packet::PT_MAX)
183	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)."),
184	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());	559	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
185	else	560	else
186	{	561	{
187	connection *c = conns[src - 1];	562	connection *c = conns[src - 1];
188		563
189	if (dst == 0 && !THISNODE->routerprio)	564	if (dst == 0)
190	slog (L_WARN, _("%s(%s): received broadcast, but we are no router"),	565	slog (L_WARN, _("%s(%s): received broadcast (protocol violation)."),
191	c->conf->nodename, (const char *)rsi);	566	c->conf->nodename, (const char *)rsi);
192	else if (dst != 0 && dst != THISNODE->id)	567	else if (dst != THISNODE->id)
193	// FORWARDING NEEDED ;)	568	{
		569	if (THISNODE->routerprio)
		570	// the tos setting gets lost here. who cares.
		571	conns[dst - 1]->inject_vpn_packet (pkt);
		572	else
194	slog (L_WARN,	573	slog (L_WARN,
195	_("received frame for node %d ('%s') from %s, but this is node %d ('%s')"),	574	_("%s(%s): request to forward packet to %s, but we are no router (config mismatch?)."),
		575	c->conf->nodename, (const char *)rsi,
196	dst, conns[dst - 1]->conf->nodename,	576	conns[dst - 1]->conf->nodename);
197	(const char *)rsi,	577	}
198	THISNODE->id, THISNODE->nodename);
199	else	578	else
200	c->recv_vpn_packet (pkt, rsi);	579	c->recv_vpn_packet (pkt, rsi);
201	}	580	}
202	}	581	}
203		582
204	void	583	bool
205	vpn::udpv4_ev (short revents)	584	vpn::send_vpn_packet (vpn_packet *pkt, const sockinfo &si, int tos)
206	{	585	{
207	if (revents & (POLLIN \| POLLERR))	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
		614	vpn::ipv4_ev (ev::io &w, int revents)
		615	{
		616	if (revents & EV_READ)
208	{	617	{
209	vpn_packet *pkt = new vpn_packet;	618	vpn_packet *pkt = new vpn_packet;
210	struct sockaddr_in sa;	619	struct sockaddr_in sa;
211	socklen_t sa_len = sizeof (sa);	620	socklen_t sa_len = sizeof (sa);
212	int len;	621	int len;
213		622
214	len = recvfrom (udpv4_fd, &((pkt)[0]), MAXSIZE, 0, (sockaddr )&sa, &sa_len);	623	len = recvfrom (w.fd, &((pkt)[0]), MAXSIZE, 0, (sockaddr )&sa, &sa_len);
215		624
216	sockinfo si(sa);	625	sockinfo si(sa, PROT_IPv4);
217		626
218	if (len > 0)	627	if (len > 0)
219	{	628	{
220	pkt->len = len;	629	pkt->len = len;
221		630
		631	// raw sockets deliver the ipv4 header, but don't expect it on sends
		632	pkt->skip_hdr (pkt->ipv4_hdr_len ());
		633
222	recv_vpn_packet (pkt, si);	634	recv_vpn_packet (pkt, si);
223	}	635	}
224	else	636	else
225	{	637	{
226	// probably ECONNRESET or somesuch	638	// probably ECONNRESET or somesuch
227	slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));	639	slog (L_DEBUG, _("%s: %s."), (const char *)si, strerror (errno));
228	}	640	}
229		641
230	delete pkt;	642	delete pkt;
231	}	643	}
232	else if (revents & POLLHUP)
233	{
234	// this cannot ;) happen on udp sockets
235	slog (L_ERR, _("FATAL: POLLHUP on udp v4 fd, terminating."));
236	exit (1);
237	}
238	else	644	else
239	{	645	{
240	slog (L_ERR,	646	slog (L_ERR,
241	_("FATAL: unknown revents %08x in socket, terminating\n"),	647	_("FATAL: unknown revents %08x in socket, exiting.\n"),
242	revents);	648	revents);
243	exit (1);	649	exit (EXIT_FAILURE);
244	}	650	}
245	}	651	}
246		652
247	void	653	#if ENABLE_ICMP
248	vpn::ipv4_ev (short revents)	654	inline void
		655	vpn::icmpv4_ev (ev::io &w, int revents)
249	{	656	{
250	if (revents & (POLLIN \| POLLERR))	657	if (revents & EV_READ)
251	{	658	{
252	vpn_packet *pkt = new vpn_packet;	659	vpn_packet *pkt = new vpn_packet;
253	struct sockaddr_in sa;	660	struct sockaddr_in sa;
254	socklen_t sa_len = sizeof (sa);	661	socklen_t sa_len = sizeof (sa);
255	int len;	662	int len;
256		663
257	len = recvfrom (ipv4_fd, &((pkt)[0]), MAXSIZE, 0, (sockaddr )&sa, &sa_len);	664	len = recvfrom (w.fd, &((pkt)[0]), MAXSIZE, 0, (sockaddr )&sa, &sa_len);
258		665
259	sockinfo si(sa, PROT_IPv4);	666	sockinfo si(sa, PROT_ICMPv4);
260		667
261	if (len > 0)	668	if (len > 0)
262	{	669	{
263	pkt->len = len;	670	pkt->len = len;
264		671
		672	icmp_header hdr = (icmp_header )&((*pkt)[IP_OVERHEAD]);
		673
		674	if (hdr->type == ::conf.icmp_type
		675	&& hdr->code == 255)
		676	{
265	// 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
266	// this is slow, but...	678	// this is slow, but...
267	pkt->skip_hdr (IP_OVERHEAD);	679	pkt->skip_hdr (pkt->ipv4_hdr_len () + (ICMP_OVERHEAD - IP_OVERHEAD));
		680
		681	recv_vpn_packet (pkt, si);
		682	}
		683	}
		684	else
		685	{
		686	// probably ECONNRESET or somesuch
		687	slog (L_DEBUG, _("%s: %s."), (const char *)si, strerror (errno));
		688	}
		689
		690	delete pkt;
		691	}
		692	else
		693	{
		694	slog (L_ERR,
		695	_("FATAL: unknown revents %08x in socket, exiting.\n"),
		696	revents);
		697	exit (EXIT_FAILURE);
		698	}
		699	}
		700	#endif
		701
		702	inline void
		703	vpn::udpv4_ev (ev::io &w, int revents)
		704	{
		705	if (revents & EV_READ)
		706	{
		707	vpn_packet *pkt = new vpn_packet;
		708	struct sockaddr_in sa;
		709	socklen_t sa_len = sizeof (sa);
		710	int len;
		711
		712	len = recvfrom (w.fd, &((pkt)[0]), MAXSIZE, 0, (sockaddr )&sa, &sa_len);
		713
		714	sockinfo si(sa, PROT_UDPv4);
		715
		716	if (len > 0)
		717	{
		718	pkt->len = len;
268		719
269	recv_vpn_packet (pkt, si);	720	recv_vpn_packet (pkt, si);
270	}	721	}
271	else	722	else
272	{	723	{
273	// probably ECONNRESET or somesuch	724	// probably ECONNRESET or somesuch
274	slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));	725	slog (L_DEBUG, _("%s: fd %d, %s."), (const char *)si, w.fd, strerror (errno));
275	}	726	}
276		727
277	delete pkt;	728	delete pkt;
278	}	729	}
279	else if (revents & POLLHUP)
280	{
281	// this cannot ;) happen on udp sockets
282	slog (L_ERR, _("FATAL: POLLHUP on ipv4 fd, terminating."));
283	exit (1);
284	}
285	else	730	else
286	{	731	{
287	slog (L_ERR,	732	slog (L_ERR,
288	_("FATAL: unknown revents %08x in socket, terminating\n"),	733	_("FATAL: unknown revents %08x in socket, exiting.\n"),
289	revents);	734	revents);
290	exit (1);	735	exit (EXIT_FAILURE);
291	}	736	}
292	}	737	}
293		738
294	void	739	inline void
295	vpn::tap_ev (short revents)	740	vpn::tap_ev (ev::io &w, int revents)
296	{	741	{
297	if (revents & POLLIN)	742	if (revents & EV_READ)
298	{	743	{
299	/* process data */	744	/* process data */
300	tap_packet *pkt;	745	tap_packet *pkt;
301		746
302	pkt = tap->recv ();	747	pkt = tap->recv ();
303		748
		749	if (!pkt)
		750	return;
		751
		752	if (pkt->len > 14)
		753	{
304	int dst = mac2id (pkt->dst);	754	int dst = mac2id (pkt->dst);
305	int src = mac2id (pkt->src);	755	int src = mac2id (pkt->src);
306		756
307	if (src != THISNODE->id)	757	if (src != THISNODE->id)
308	{
309	slog (L_ERR, _("FATAL: tap packet not originating on current node received, terminating."));
310	exit (1);
311	}
312
313	if (dst == THISNODE->id)
314	{
315	slog (L_ERR, _("FATAL: tap packet destined for current node received, terminating."));
316	exit (1);
317	}
318
319	if (dst > conns.size ())
320	slog (L_ERR, _("tap packet for unknown node %d received, ignoring."), dst);
321	else
322	{
323	if (dst)
324	{	758	{
325	// unicast	759	slog (L_ERR, _("FATAL: tap packet not originating on current node received (if-up script not working properly?), exiting."));
326	if (dst != THISNODE->id)	760	exit (EXIT_FAILURE);
327	conns[dst - 1]->inject_data_packet (pkt);
328	}	761	}
		762
		763	if (dst == THISNODE->id)
		764	{
		765	slog (L_ERR, _("FATAL: tap packet destined for current node received, exiting."));
		766	exit (EXIT_FAILURE);
		767	}
		768
		769	if (dst > conns.size ())
		770	slog (L_ERR, _("tap packet for unknown node %d received, ignoring."), dst);
329	else	771	else
330	{
331	// broadcast, first check router, then self, then english
332	connection *router = find_router ();
333
334	if (router)
335	router->inject_data_packet (pkt, true);	772	inject_data_packet (pkt, dst);
336	else
337	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
338	if ((*c)->conf != THISNODE)
339	(*c)->inject_data_packet (pkt);
340	}
341	}	773	}
342		774
343	delete pkt;	775	delete pkt;
344	}
345	else if (revents & (POLLHUP \| POLLERR))
346	{
347	slog (L_ERR, _("FATAL: POLLHUP or POLLERR on network device fd, terminating."));
348	exit (1);
349	}	776	}
350	else	777	else
351	abort ();	778	abort ();
352	}	779	}
353		780
354	void	781	inline void
355	vpn::event_cb (tstamp &ts)	782	vpn::event_cb (ev::timer &w, int)
356	{	783	{
357	if (events)	784	if (events)
358	{	785	{
359	if (events & EVENT_SHUTDOWN)	786	if (events & EVENT_SHUTDOWN)
360	{	787	{
361	slog (L_INFO, _("preparing shutdown..."));	788	slog (L_INFO, _("preparing shutdown..."));
362		789
363	shutdown_all ();	790	shutdown_all ();
364
365	remove_pid (pidfilename);	791	remove_pid (conf.pidfilename);
366
367	slog (L_INFO, _("terminating"));	792	slog (L_INFO, _("exiting."));
368		793	exit (EXIT_SUCCESS);
369	exit (0);
370	}	794	}
371		795
372	if (events & EVENT_RECONNECT)	796	if (events & EVENT_RECONNECT)
373	{	797	{
374	slog (L_INFO, _("forced reconnect"));	798	slog (L_INFO, _("forced reconnect."));
375		799
376	reconnect_all ();	800	reconnect_all ();
377	}	801	}
378		802
379	events = 0;	803	events = 0;
380	}	804	}
381
382	ts = TSTAMP_CANCEL;
383	}	805	}
384		806
385	void	807	void
386	vpn::shutdown_all ()	808	vpn::shutdown_all ()
387	{	809	{
397		819
398	conns.clear ();	820	conns.clear ();
399		821
400	connection_init ();	822	connection_init ();
401		823
402	for (configuration::node_vector::iterator i = conf.nodes.begin ();	824	for (configuration::node_vector::iterator i = conf.nodes.begin (); i != conf.nodes.end (); ++i)
403	i != conf.nodes.end (); ++i)	825	conns.push_back (new connection (this, *i));
404	{
405	connection *conn = new connection (this);
406		826
407	conn->conf = *i;	827	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
408	conns.push_back (conn);
409
410	conn->establish_connection ();	828	(*c)->establish_connection ();
411	}
412	}	829	}
413		830
414	connection *vpn::find_router ()	831	bool
		832	vpn::can_direct (conf_node src, conf_node dst) const
415	{	833	{
416	u32 prio = 0;	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	{
417	connection *router = 0;	846	connection *router = 0;
418		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	{
419	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)	896	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
420	{	897	{
421	connection c = i;	898	connection o = i;
422		899
423	if (c->conf->routerprio > prio	900	if (!o->is_direct
424	&& c->connectmode == conf_node::C_ALWAYS	901	&& o->si.valid ()
425	&& c->conf != THISNODE	902	&& c->si != o->si
426	&& c->ictx && c->octx)	903	&& c == find_router_for (o))
427	{
428	prio = c->conf->routerprio;
429	router = c;
430	}	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	}
431	}	909	}
432
433	return router;
434	}	910	}
435		911
436	void vpn::connect_request (int id)	912	void
		913	vpn::send_connect_request (connection *c)
437	{	914	{
438	connection *c = find_router ();	915	connection *r = find_router_for (c);
439		916
440	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);
441	c->connect_request (id);	921	r->send_connect_request (c->conf->id);
442	//else // does not work, because all others must connect to the same router	922	}
443	// // no router found, aggressively connect to all routers	923	else
444	// for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)	924	slog (L_DEBUG, _("%s: no way to connect and no router found: unable to connect at this time."),
445	// if ((*i)->conf->routerprio)	925	c->conf->nodename);
446	// (*i)->establish_connection ();
447	}	926	}
448		927
449	void	928	void
450	connection::dump_status ()	929	connection::dump_status ()
451	{	930	{
452	slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);	931	slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);
453	slog (L_NOTICE, _(" connectmode %d (%d) / sockaddr %s / minor %d"),	932	slog (L_NOTICE, _(" connectmode %d (%d) / sockaddr %s / minor %d"),
454	connectmode, conf->connectmode, (const char *)si, (int)prot_minor);	933	connectmode, conf->connectmode, (const char *)si, (int)prot_minor);
455	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"),
456	(long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);	935	(long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);
457	slog (L_NOTICE, _(" establish_conn %ld / rekey %ld / keepalive %ld"),
458	(long)(establish_connection.at), (long)(rekey.at), (long)(keepalive.at));
459	}	936	}
460		937
461	void	938	void
462	vpn::dump_status ()	939	vpn::dump_status ()
463	{	940	{
464	slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)NOW);	941	slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)ev_now ());
465		942
466	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)	943	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
467	(*c)->dump_status ();	944	(*c)->dump_status ();
468		945
469	slog (L_NOTICE, _("END status dump"));	946	slog (L_NOTICE, _("END status dump"));
470	}	947	}
471		948
472	vpn::vpn (void)	949	vpn::vpn (void)
		950	{
		951	event .set<vpn, &vpn::event_cb > (this);
473	: udpv4_ev_watcher(this, &vpn::udpv4_ev)	952	udpv4_ev_watcher .set<vpn, &vpn::udpv4_ev > (this);
474	, ipv4_ev_watcher(this, &vpn::ipv4_ev)	953	ipv4_ev_watcher .set<vpn, &vpn::ipv4_ev > (this);
475	, tap_ev_watcher(this, &vpn::tap_ev)	954	#if ENABLE_TCP
476	, event(this, &vpn::event_cb)	955	tcpv4_ev_watcher .set<vpn, &vpn::tcpv4_ev > (this);
477	{	956	#endif
		957	#if ENABLE_ICMP
		958	icmpv4_ev_watcher.set<vpn, &vpn::icmpv4_ev> (this);
		959	#endif
		960	#if ENABLE_DNS
		961	dnsv4_ev_watcher .set<vpn, &vpn::dnsv4_ev > (this);
		962	#endif
		963	tap_ev_watcher .set<vpn, &vpn::tap_ev > (this);
478	}	964	}
479		965
480	vpn::~vpn ()	966	vpn::~vpn ()
481	{	967	{
482	}	968	}

Diff Legend

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

Comparing gvpe/src/vpn.C (file contents): Revision 1.1 by pcg, Wed Apr 2 03:25:17 2003 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.1 by pcg, Wed Apr 2 03:25:17 2003 UTC vs.
Revision 1.64 by root, Tue Dec 4 10:29:43 2012 UTC