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

Comparing gvpe/src/vpn.C (file contents):
Revision 1.9 by pcg, Tue Apr 8 02:00:54 2003 UTC vs.
Revision 1.56 by root, Tue Feb 8 23:11:36 2011 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 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 <errno.h>	43	#include <errno.h>
32	#include <time.h>	44	#include <time.h>
33	#include <unistd.h>	45	#include <unistd.h>
34	#include <arpa/inet.h>	46	#include <fcntl.h>
35	#include <netinet/in.h>	47	#include <sys/socket.h>
36	#include <netinet/icmp.h>	48
		49	#include "netcompat.h"
37		50
38	#include "pidfile.h"	51	#include "pidfile.h"
39		52
40	#include "connection.h"	53	#include "connection.h"
41	#include "util.h"	54	#include "util.h"
42	#include "vpn.h"	55	#include "vpn.h"
43		56
		57	vpn network; // THE vpn (bad design...)
		58
44	/////////////////////////////////////////////////////////////////////////////	59	/////////////////////////////////////////////////////////////////////////////
45		60
46	const char *vpn::script_if_up ()	61	static void inline
		62	set_tos (int fd, int &tos_prev, int tos)
		63	{
		64	#if defined(SOL_IP) && defined(IP_TOS)
		65	if (tos_prev == tos)
		66	return;
		67
		68	tos_prev = tos;
		69	setsockopt (fd, SOL_IP, IP_TOS, &tos, sizeof tos);
		70	#endif
		71	}
		72
		73	void
		74	vpn::script_init_env ()
47	{	75	{
48	// the tunnel device mtu should be the physical mtu - overhead	76	// the tunnel device mtu should be the physical mtu - overhead
49	// the tricky part is rounding to the cipher key blocksize	77	// the tricky part is rounding to the cipher key blocksize
50	int mtu = conf.mtu - ETH_OVERHEAD - VPE_OVERHEAD - MAX_OVERHEAD;	78	int mtu = conf.mtu - ETH_OVERHEAD - VPE_OVERHEAD - MAX_OVERHEAD;
51	mtu += ETH_OVERHEAD - 6 - 6; // now we have the data portion	79	mtu += ETH_OVERHEAD - 6 - 6; // now we have the data portion
52	mtu -= mtu % EVP_CIPHER_block_size (CIPHER); // round	80	mtu -= mtu % EVP_CIPHER_block_size (CIPHER); // round
53	mtu -= ETH_OVERHEAD - 6 - 6; // and get interface mtu again	81	mtu -= ETH_OVERHEAD - 6 - 6; // and get interface mtu again
54		82
55	char *env;	83	char *env;
56	asprintf (&env, "CONFBASE=%s", confbase);	84	asprintf (&env, "CONFBASE=%s", confbase); putenv (env);
57	putenv (env);
58	asprintf (&env, "NODENAME=%s", THISNODE->nodename);
59	putenv (env);
60	asprintf (&env, "NODEID=%d", THISNODE->id);
61	putenv (env);
62	asprintf (&env, "IFNAME=%s", tap->interface ());	85	asprintf (&env, "IFNAME=%s", tap->interface ()); putenv (env);
63	putenv (env);	86	asprintf (&env, "IFTYPE=%s", IFTYPE); putenv (env);
		87	asprintf (&env, "IFSUBTYPE=%s", IFSUBTYPE); putenv (env);
64	asprintf (&env, "MTU=%d", mtu);	88	asprintf (&env, "MTU=%d", mtu); putenv (env);
65	putenv (env);	89	asprintf (&env, "NODES=%d", conns.size ()); putenv (env);
66	asprintf (&env, "MAC=%02x:%02x:%02x:%02x:%02x:%02x",	90	asprintf (&env, "NODEID=%d", THISNODE->id); putenv (env);
67	0xfe, 0xfd, 0x80, 0x00, THISNODE->id >> 8,
68	THISNODE->id & 0xff);
69	putenv (env);
70		91
		92	conns [THISNODE->id - 1]->script_init_env ("");
		93
		94	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
		95	{
		96	char ext[16];
		97	snprintf (ext, 16, "_%d", (*c)->conf->id);
		98	(*c)->script_init_env (ext);
		99	}
		100	}
		101
		102	inline const char *
		103	vpn::script_if_init ()
		104	{
		105	script_init_env ();
		106
		107	return tap->if_up ();
		108	}
		109
		110	inline const char *
		111	vpn::script_if_up ()
		112	{
		113	script_init_env ();
		114
		115	char *filename;
		116	asprintf (&filename,
		117	"%s/%s",
		118	confbase,
71	return ::conf.script_if_up ? ::conf.script_if_up : "if-up";	119	::conf.script_if_up ? ::conf.script_if_up : "if-up");
		120
		121	return filename;
		122	}
		123
		124	int
		125	vpn::setup_socket (u8 prot, int family, int type, int proto)
		126	{
		127	int fd = socket (family, type, proto);
		128
		129	if (fd < 0)
		130	{
		131	slog (L_ERR, _("unable to create %s socket: %s."), strprotocol (prot), strerror (errno));
		132	return fd;
		133	}
		134
		135	fcntl (fd, F_SETFL, O_NONBLOCK);
		136	fcntl (fd, F_SETFD, FD_CLOEXEC);
		137
		138	#ifdef SO_MARK
		139	if (::conf.nfmark)
		140	if (setsockopt (fd, SOL_SOCKET, SO_MARK, &::conf.nfmark, sizeof ::conf.nfmark))
		141	slog (L_WARN, _("unable to set nfmark on %s socket: %s"), strprotocol (prot), strerror (errno));
		142	#endif
		143
		144	return fd;
72	}	145	}
73		146
74	int	147	int
75	vpn::setup ()	148	vpn::setup ()
76	{	149	{
		150	int success = 0;
		151
		152	ipv4_tos = -1;
77	ipv4_fd = -1;	153	ipv4_fd = -1;
78		154
79	if (THISNODE->protocols & PROT_IPv4 && ::conf.ip_proto)	155	if (THISNODE->protocols & PROT_IPv4 && ::conf.ip_proto)
80	{	156	{
81	ipv4_fd = socket (PF_INET, SOCK_RAW, ::conf.ip_proto);	157	ipv4_fd = setup_socket (PROT_IPv4, PF_INET, SOCK_RAW, ::conf.ip_proto);
82		158
83	if (ipv4_fd < 0)	159	if (ipv4_fd < 0)
84	return -1;	160	return -1;
85		161
86	#ifdef IP_MTU_DISCOVER	162	#if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
87	// this I really consider a linux bug. I am neither connected	163	// this I really consider a linux bug. I am neither connected
88	// nor do I fragment myself. Linux still sets DF and doesn't	164	// nor do I fragment myself. Linux still sets DF and doesn't
89	// fragment for me sometimes.	165	// fragment for me sometimes.
90	{	166	{
91	int oval = IP_PMTUDISC_DONT;	167	int oval = IP_PMTUDISC_DONT;
95		171
96	sockinfo si (THISNODE, PROT_IPv4);	172	sockinfo si (THISNODE, PROT_IPv4);
97		173
98	if (bind (ipv4_fd, si.sav4 (), si.salenv4 ()))	174	if (bind (ipv4_fd, si.sav4 (), si.salenv4 ()))
99	{	175	{
100	slog (L_ERR, _("can't bind ipv4 socket on %s: %s"), (const char *)si, strerror (errno));	176	slog (L_ERR, _("can't bind ipv4 socket on %s: %s, exiting."), (const char *)si, strerror (errno));
101	exit (1);	177	return -1;
102	}	178	}
103		179
104	ipv4_ev_watcher.start (ipv4_fd, POLLIN);	180	ipv4_ev_watcher.start (ipv4_fd, EV_READ);
		181	++success;
105	}	182	}
		183	else
		184	THISNODE->protocols &= ~PROT_IPv4;
106		185
		186	udpv4_tos = -1;
107	udpv4_fd = -1;	187	udpv4_fd = -1;
108		188
109	if (THISNODE->protocols & PROT_UDPv4 && THISNODE->udp_port)	189	if (THISNODE->protocols & PROT_UDPv4 && THISNODE->udp_port)
110	{	190	{
111	udpv4_fd = socket (PF_INET, SOCK_DGRAM, IPPROTO_UDP);	191	udpv4_fd = setup_socket (PROT_UDPv4, PF_INET, SOCK_DGRAM, IPPROTO_UDP);
112		192
113	if (udpv4_fd < 0)	193	if (udpv4_fd < 0)
114	return -1;	194	return -1;
115		195
116	// standard daemon practise...	196	// standard daemon practise...
117	{	197	{
118	int oval = 1;	198	int oval = 1;
119	setsockopt (udpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);	199	setsockopt (udpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
120	}	200	}
121		201
122	#ifdef IP_MTU_DISCOVER	202	#if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
123	// this I really consider a linux bug. I am neither connected	203	// this I really consider a linux bug. I am neither connected
124	// nor do I fragment myself. Linux still sets DF and doesn't	204	// nor do I fragment myself. Linux still sets DF and doesn't
125	// fragment for me sometimes.	205	// fragment for me sometimes.
126	{	206	{
127	int oval = IP_PMTUDISC_DONT;	207	int oval = IP_PMTUDISC_DONT;
…		…
131		211
132	sockinfo si (THISNODE, PROT_UDPv4);	212	sockinfo si (THISNODE, PROT_UDPv4);
133		213
134	if (bind (udpv4_fd, si.sav4 (), si.salenv4 ()))	214	if (bind (udpv4_fd, si.sav4 (), si.salenv4 ()))
135	{	215	{
136	slog (L_ERR, _("can't bind udpv4 on %s: %s"), (const char *)si, strerror (errno));	216	slog (L_ERR, _("can't bind udpv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
137	exit (1);	217	return -1;
138	}	218	}
139		219
140	udpv4_ev_watcher.start (udpv4_fd, POLLIN);	220	udpv4_ev_watcher.start (udpv4_fd, EV_READ);
		221	++success;
141	}	222	}
		223	else
		224	THISNODE->protocols &= ~PROT_UDPv4;
142		225
		226	icmpv4_tos = -1;
143	icmpv4_fd = -1;	227	icmpv4_fd = -1;
144		228
145	#if ENABLE_ICMP	229	#if ENABLE_ICMP
146	if (THISNODE->protocols & PROT_ICMPv4)	230	if (THISNODE->protocols & PROT_ICMPv4)
147	{	231	{
148	icmpv4_fd = socket (PF_INET, SOCK_RAW, IPPROTO_ICMP);	232	icmpv4_fd = setup_socket (PROT_ICMPv4, PF_INET, SOCK_RAW, IPPROTO_ICMP);
149		233
150	if (icmpv4_fd < 0)	234	if (icmpv4_fd < 0)
151	return -1;	235	return -1;
152		236
153	#ifdef ICMP_FILTER	237	#ifdef ICMP_FILTER
…		…
159		243
160	setsockopt (icmpv4_fd, SOL_RAW, ICMP_FILTER, &oval, sizeof oval);	244	setsockopt (icmpv4_fd, SOL_RAW, ICMP_FILTER, &oval, sizeof oval);
161	}	245	}
162	#endif	246	#endif
163		247
164	#ifdef IP_MTU_DISCOVER	248	#if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
165	// this I really consider a linux bug. I am neither connected	249	// this I really consider a linux bug. I am neither connected
166	// nor do I fragment myself. Linux still sets DF and doesn't	250	// nor do I fragment myself. Linux still sets DF and doesn't
167	// fragment for me sometimes.	251	// fragment for me sometimes.
168	{	252	{
169	int oval = IP_PMTUDISC_DONT;	253	int oval = IP_PMTUDISC_DONT;
170	setsockopt (udpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);	254	setsockopt (icmpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
171	}	255	}
172	#endif	256	#endif
173		257
174	sockinfo si (THISNODE, PROT_ICMPv4);	258	sockinfo si (THISNODE, PROT_ICMPv4);
175		259
176	if (bind (icmpv4_fd, si.sav4 (), si.salenv4 ()))	260	if (bind (icmpv4_fd, si.sav4 (), si.salenv4 ()))
177	{	261	{
178	slog (L_ERR, _("can't bind icmpv4 on %s: %s"), (const char *)si, strerror (errno));	262	slog (L_ERR, _("can't bind icmpv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
179	exit (1);	263	return -1;
180	}	264	}
181		265
182	icmpv4_ev_watcher.start (icmpv4_fd, POLLIN);	266	icmpv4_ev_watcher.start (icmpv4_fd, EV_READ);
		267	++success;
183	}	268	}
184	#endif	269	#endif
185		270
186	tcpv4_fd = -1;	271	tcpv4_fd = -1;
187		272
188	#if ENABLE_TCP	273	#if ENABLE_TCP
189	if (THISNODE->protocols & PROT_TCPv4 && THISNODE->tcp_port)	274	if (THISNODE->protocols & PROT_TCPv4 && THISNODE->tcp_port)
190	{	275	{
191	tcpv4_fd = socket (PF_INET, SOCK_STREAM, IPPROTO_TCP);	276	tcpv4_fd = setup_socket (PROT_TCPv4, PF_INET, SOCK_STREAM, IPPROTO_TCP);
192		277
193	if (tcpv4_fd < 0)	278	if (tcpv4_fd < 0)
194	return -1;	279	return -1;
195		280
196	// standard daemon practise...	281	// standard daemon practise...
…		…
201		286
202	sockinfo si (THISNODE, PROT_TCPv4);	287	sockinfo si (THISNODE, PROT_TCPv4);
203		288
204	if (bind (tcpv4_fd, si.sav4 (), si.salenv4 ()))	289	if (bind (tcpv4_fd, si.sav4 (), si.salenv4 ()))
205	{	290	{
206	slog (L_ERR, _("can't bind tcpv4 on %s: %s"), (const char *)si, strerror (errno));	291	slog (L_ERR, _("can't bind tcpv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
207	exit (1);	292	return -1;
208	}	293	}
209		294
210	if (listen (tcpv4_fd, 5))	295	if (listen (tcpv4_fd, 5))
211	{	296	{
212	slog (L_ERR, _("can't listen tcpv4 on %s: %s"), (const char *)si, strerror (errno));	297	slog (L_ERR, _("can't listen tcpv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
213	exit (1);	298	return -1;
		299	}
		300
		301	tcpv4_ev_watcher.start (tcpv4_fd, EV_READ);
		302	++success;
		303	}
		304	else
		305	THISNODE->protocols &= ~PROT_TCPv4;
		306	#endif
		307
		308	dnsv4_tos = -1;
		309	dnsv4_fd = -1;
		310
		311	#if ENABLE_DNS
		312	if (THISNODE->protocols & PROT_DNSv4)
		313	{
		314	dns_forwarder.set (::conf.dns_forw_host, ::conf.dns_forw_port, PROT_DNSv4);
		315
		316	dnsv4_fd = setup_socket (PROT_DNSv4, PF_INET, SOCK_DGRAM, IPPROTO_UDP);
		317
		318	if (dnsv4_fd < 0)
		319	return -1;
		320
		321	# if defined(SOL_IP) && defined(IP_MTU_DISCOVER)
		322	// this I really consider a linux bug. I am neither connected
		323	// nor do I fragment myself. Linux still sets DF and doesn't
		324	// fragment for me sometimes.
		325	{
		326	int oval = IP_PMTUDISC_DONT;
		327	setsockopt (dnsv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
214	}	328	}
215
216	tcpv4_ev_watcher.start (tcpv4_fd, POLLIN);
217	}
218	#endif	329	# endif
		330
		331	// standard daemon practise...
		332	{
		333	int oval = 1;
		334	setsockopt (dnsv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
		335	}
		336
		337	sockinfo si (THISNODE->dns_hostname,
		338	THISNODE->dns_hostname ? THISNODE->dns_port : 0,
		339	PROT_DNSv4);
		340
		341	if (bind (dnsv4_fd, si.sav4 (), si.salenv4 ()))
		342	{
		343	slog (L_ERR, _("can't bind dnsv4 on %s: %s, exiting."), (const char *)si, strerror (errno));
		344	return -1;
		345	}
		346
		347	dnsv4_ev_watcher.start (dnsv4_fd, EV_READ);
		348	++success;
		349	}
		350	#endif
		351
		352	/////////////////////////////////////////////////////////////////////////////
		353
		354	if (!success)
		355	{
		356	slog (L_ERR, _("no protocols enabled."));
		357	return -1;
		358	}
		359
		360	reconnect_all ();
		361
		362	/////////////////////////////////////////////////////////////////////////////
219		363
220	tap = new tap_device ();	364	tap = new tap_device ();
221	if (!tap) //D this, of course, never catches	365	if (!tap) //D this, of course, never catches
222	{	366	{
223	slog (L_ERR, _("cannot create network interface '%s'"), conf.ifname);	367	slog (L_ERR, _("cannot create network interface '%s'."), conf.ifname);
224	exit (1);	368	return -1;
225	}	369	}
226		370
227	run_script (run_script_cb (this, &vpn::script_if_up), true);	371	fcntl (tap->fd, F_SETFD, FD_CLOEXEC);
228		372
		373	run_script_cb cb;
		374	cb.set<vpn, &vpn::script_if_init> (this);
		375
		376	if (tap->if_up () &&
		377	!run_script (cb, true))
		378	{
		379	slog (L_ERR, _("interface initialization command '%s' failed."),
		380	tap->if_up ());
		381	return -1;
		382	}
		383
		384	cb.set<vpn, &vpn::script_if_up> (this);
		385	if (!run_script (cb, true))
		386	{
		387	slog (L_ERR, _("if-up command execution failed."));
		388	return -1;
		389	}
		390
229	tap_ev_watcher.start (tap->fd, POLLIN);	391	tap_ev_watcher.start (tap->fd, EV_READ);
230
231	reconnect_all ();
232		392
233	return 0;	393	return 0;
234	}
235
236	// send a vpn packet out to other hosts
237	bool
238	vpn::send_vpn_packet (vpn_packet *pkt, const sockinfo &si, int tos)
239	{
240	switch (si.prot)
241	{
242	case PROT_IPv4:
243	return send_ipv4_packet (pkt, si, tos);
244
245	case PROT_UDPv4:
246	return send_udpv4_packet (pkt, si, tos);
247
248	#if ENABLE_TCP
249	case PROT_TCPv4:
250	return send_tcpv4_packet (pkt, si, tos);
251	#endif
252
253	#if ENABLE_ICMP
254	case PROT_ICMPv4:
255	return send_icmpv4_packet (pkt, si, tos);
256	#endif
257
258	default:
259	slog (L_CRIT, _("%s: FATAL: trying to send packet with unsupported protocol"), (const char *)si);
260	return false;
261	}
262	}	394	}
263		395
264	bool	396	bool
265	vpn::send_ipv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)	397	vpn::send_ipv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
266	{	398	{
267	setsockopt (ipv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);	399	set_tos (ipv4_fd, ipv4_tos, tos);
268	sendto (ipv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());	400	sendto (ipv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
269		401
270	return true;	402	return true;
271	}	403	}
272		404
…		…
291	sum += (sum >> 16); // carry	423	sum += (sum >> 16); // carry
292		424
293	return ~sum;	425	return ~sum;
294	}	426	}
295		427
		428	#if ENABLE_ICMP
296	bool	429	bool
297	vpn::send_icmpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)	430	vpn::send_icmpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
298	{	431	{
299	setsockopt (icmpv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
300
301	pkt->unshift_hdr (4);	432	pkt->unshift_hdr (4);
302		433
303	icmphdr hdr = (icmphdr )&((*pkt)[0]);	434	icmp_header hdr = (icmp_header )&((*pkt)[0]);
304	hdr->type = ::conf.icmp_type;	435	hdr->type = ::conf.icmp_type;
305	hdr->code = 255;	436	hdr->code = 255;
306	hdr->checksum = 0;	437	hdr->checksum = 0;
307	hdr->checksum = ipv4_checksum ((u16 *)hdr, pkt->len);	438	hdr->checksum = ipv4_checksum ((u16 *)hdr, pkt->len);
308		439
		440	set_tos (icmpv4_fd, icmpv4_tos, tos);
309	sendto (icmpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());	441	sendto (icmpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
310		442
311	return true;	443	return true;
312	}	444	}
		445	#endif
313		446
314	bool	447	bool
315	vpn::send_udpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)	448	vpn::send_udpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
316	{	449	{
317	setsockopt (udpv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);	450	set_tos (udpv4_fd, udpv4_tos, tos);
318	sendto (udpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());	451	sendto (udpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
319		452
320	return true;	453	return true;
		454	}
		455
		456	void
		457	vpn::inject_data_packet (tap_packet *pkt, int dst)
		458	{
		459	if (dst)
		460	{
		461	// unicast
		462	if (dst != THISNODE->id)
		463	conns[dst - 1]->inject_data_packet (pkt);
		464	}
		465	else
		466	{
		467	// broadcast, this is ugly, but due to the security policy
		468	// we have to connect to all hosts...
		469	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
		470	if ((*c)->conf != THISNODE)
		471	(*c)->inject_data_packet (pkt);
		472	}
321	}	473	}
322		474
323	void	475	void
324	vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)	476	vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)
325	{	477	{
326	unsigned int src = pkt->src ();	478	unsigned int src = pkt->src ();
327	unsigned int dst = pkt->dst ();	479	unsigned int dst = pkt->dst ();
328		480
329	slog (L_NOISE, _("<<?/%s received possible vpn packet type %d from %d to %d, length %d"),	481	slog (L_NOISE, _("<<?/%s received possible vpn packet type %d from %d to %d, length %d."),
330	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst (), pkt->len);	482	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst (), pkt->len);
331		483
332	if (src == 0 \|\| src > conns.size ()	484	if (src == 0 \|\| src > conns.size ()
333	\|\| dst > conns.size ()	485	\|\| dst > conns.size ()
334	\|\| pkt->typ () >= vpn_packet::PT_MAX)	486	\|\| pkt->typ () >= vpn_packet::PT_MAX)
335	slog (L_WARN, _("(%s): received corrupted packet type %d (src %d, dst %d)"),	487	slog (L_WARN, _("(%s): received corrupted packet type %d (src %d, dst %d)."),
336	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());	488	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
337	else if (dst > conns.size ())	489	else if (dst > conns.size ())
338	slog (L_WARN, _("(%s): received corrupted packet type %d (src %d, dst %d)"),	490	slog (L_WARN, _("(%s): received corrupted packet type %d (src %d, dst %d)."),
339	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());	491	(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
340	else	492	else
341	{	493	{
342	connection *c = conns[src - 1];	494	connection *c = conns[src - 1];
343		495
344	if (dst == 0 && !THISNODE->routerprio)	496	if (dst == 0)
345	slog (L_WARN, _("%s(%s): received broadcast, but we are no router"),	497	slog (L_WARN, _("%s(%s): received broadcast (protocol violation)."),
346	c->conf->nodename, (const char *)rsi);	498	c->conf->nodename, (const char *)rsi);
347	else if (dst != 0 && dst != THISNODE->id)	499	else if (dst != THISNODE->id)
348	{	500	{
349	if (THISNODE->routerprio)	501	if (THISNODE->routerprio)
350	// the tos setting gets lost here. who cares.	502	// the tos setting gets lost here. who cares.
351	conns[dst - 1]->inject_vpn_packet (pkt);	503	conns[dst - 1]->inject_vpn_packet (pkt);
352	else	504	else
353	slog (L_WARN,	505	slog (L_WARN,
354	_("%s(%s): forwarding request (=> %s), but we are no router"),	506	_("%s(%s): request to forward packet to %s, but we are no router (config mismatch?)."),
355	c->conf->nodename, (const char *)rsi,	507	c->conf->nodename, (const char *)rsi,
356	conns[dst - 1]->conf->nodename);	508	conns[dst - 1]->conf->nodename);
357	}	509	}
358	else	510	else
359	c->recv_vpn_packet (pkt, rsi);	511	c->recv_vpn_packet (pkt, rsi);
360	}	512	}
361	}	513	}
362		514
363	void	515	bool
		516	vpn::send_vpn_packet (vpn_packet *pkt, const sockinfo &si, int tos)
		517	{
		518	switch (si.prot)
		519	{
		520	case PROT_IPv4:
		521	return send_ipv4_packet (pkt, si, tos);
		522
		523	case PROT_UDPv4:
		524	return send_udpv4_packet (pkt, si, tos);
		525
		526	#if ENABLE_TCP
		527	case PROT_TCPv4:
		528	return send_tcpv4_packet (pkt, si, tos);
		529	#endif
		530	#if ENABLE_ICMP
		531	case PROT_ICMPv4:
		532	return send_icmpv4_packet (pkt, si, tos);
		533	#endif
		534	#if ENABLE_DNS
		535	case PROT_DNSv4:
		536	return send_dnsv4_packet (pkt, si, tos);
		537	#endif
		538	default:
		539	slog (L_CRIT, _("%s: FATAL: trying to send packet with unsupported protocol."), (const char *)si);
		540	}
		541
		542	return false;
		543	}
		544
		545	inline void
364	vpn::ipv4_ev (io_watcher &w, short revents)	546	vpn::ipv4_ev (ev::io &w, int revents)
365	{	547	{
366	if (revents & (POLLIN \| POLLERR))	548	if (revents & EV_READ)
367	{	549	{
368	vpn_packet *pkt = new vpn_packet;	550	vpn_packet *pkt = new vpn_packet;
369	struct sockaddr_in sa;	551	struct sockaddr_in sa;
370	socklen_t sa_len = sizeof (sa);	552	socklen_t sa_len = sizeof (sa);
371	int len;	553	int len;
…		…
376		558
377	if (len > 0)	559	if (len > 0)
378	{	560	{
379	pkt->len = len;	561	pkt->len = len;
380		562
381	// raw sockets deliver the ipv4, but don't expect it on sends	563	// raw sockets deliver the ipv4 header, but don't expect it on sends
382	// this is slow, but...
383	pkt->skip_hdr (IP_OVERHEAD);	564	pkt->skip_hdr (IP_OVERHEAD);
384		565
385	recv_vpn_packet (pkt, si);	566	recv_vpn_packet (pkt, si);
386	}	567	}
387	else	568	else
388	{	569	{
389	// probably ECONNRESET or somesuch	570	// probably ECONNRESET or somesuch
390	slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));	571	slog (L_DEBUG, _("%s: %s."), (const char *)si, strerror (errno));
391	}	572	}
392		573
393	delete pkt;	574	delete pkt;
394	}	575	}
395	else if (revents & POLLHUP)
396	{
397	// this cannot ;) happen on udp sockets
398	slog (L_ERR, _("FATAL: POLLHUP on ipv4 fd, terminating."));
399	exit (1);
400	}
401	else	576	else
402	{	577	{
403	slog (L_ERR,	578	slog (L_ERR,
404	_("FATAL: unknown revents %08x in socket, terminating\n"),	579	_("FATAL: unknown revents %08x in socket, exiting.\n"),
405	revents);	580	revents);
406	exit (1);	581	exit (EXIT_FAILURE);
407	}	582	}
408	}	583	}
409		584
410	void	585	#if ENABLE_ICMP
		586	inline void
411	vpn::icmpv4_ev (io_watcher &w, short revents)	587	vpn::icmpv4_ev (ev::io &w, int revents)
412	{	588	{
413	if (revents & (POLLIN \| POLLERR))	589	if (revents & EV_READ)
414	{	590	{
415	vpn_packet *pkt = new vpn_packet;	591	vpn_packet *pkt = new vpn_packet;
416	struct sockaddr_in sa;	592	struct sockaddr_in sa;
417	socklen_t sa_len = sizeof (sa);	593	socklen_t sa_len = sizeof (sa);
418	int len;	594	int len;
…		…
423		599
424	if (len > 0)	600	if (len > 0)
425	{	601	{
426	pkt->len = len;	602	pkt->len = len;
427		603
428	icmphdr hdr = (icmphdr )&((*pkt)[IP_OVERHEAD]);	604	icmp_header hdr = (icmp_header )&((*pkt)[IP_OVERHEAD]);
429		605
430	if (hdr->type == ::conf.icmp_type	606	if (hdr->type == ::conf.icmp_type
431	&& hdr->code == 255)	607	&& hdr->code == 255)
432	{	608	{
433	// raw sockets deliver the ipv4, but don't expect it on sends	609	// raw sockets deliver the ipv4, but don't expect it on sends
…		…
438	}	614	}
439	}	615	}
440	else	616	else
441	{	617	{
442	// probably ECONNRESET or somesuch	618	// probably ECONNRESET or somesuch
443	slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));	619	slog (L_DEBUG, _("%s: %s."), (const char *)si, strerror (errno));
444	}	620	}
445		621
446	delete pkt;	622	delete pkt;
447	}	623	}
448	else if (revents & POLLHUP)
449	{
450	// this cannot ;) happen on udp sockets
451	slog (L_ERR, _("FATAL: POLLHUP on icmpv4 fd, terminating."));
452	exit (1);
453	}
454	else	624	else
455	{	625	{
456	slog (L_ERR,	626	slog (L_ERR,
457	_("FATAL: unknown revents %08x in socket, terminating\n"),	627	_("FATAL: unknown revents %08x in socket, exiting.\n"),
458	revents);	628	revents);
459	exit (1);	629	exit (EXIT_FAILURE);
460	}	630	}
461	}	631	}
		632	#endif
462		633
463	void	634	inline void
464	vpn::udpv4_ev (io_watcher &w, short revents)	635	vpn::udpv4_ev (ev::io &w, int revents)
465	{	636	{
466	if (revents & (POLLIN \| POLLERR))	637	if (revents & EV_READ)
467	{	638	{
468	vpn_packet *pkt = new vpn_packet;	639	vpn_packet *pkt = new vpn_packet;
469	struct sockaddr_in sa;	640	struct sockaddr_in sa;
470	socklen_t sa_len = sizeof (sa);	641	socklen_t sa_len = sizeof (sa);
471	int len;	642	int len;
…		…
481	recv_vpn_packet (pkt, si);	652	recv_vpn_packet (pkt, si);
482	}	653	}
483	else	654	else
484	{	655	{
485	// probably ECONNRESET or somesuch	656	// probably ECONNRESET or somesuch
486	slog (L_DEBUG, _("%s: fd %d, %s"), (const char *)si, w.fd, strerror (errno));	657	slog (L_DEBUG, _("%s: fd %d, %s."), (const char *)si, w.fd, strerror (errno));
487	}	658	}
488		659
489	delete pkt;	660	delete pkt;
490	}	661	}
491	else if (revents & POLLHUP)
492	{
493	// this cannot ;) happen on udp sockets
494	slog (L_ERR, _("FATAL: POLLHUP on udp v4 fd, terminating."));
495	exit (1);
496	}
497	else	662	else
498	{	663	{
499	slog (L_ERR,	664	slog (L_ERR,
500	_("FATAL: unknown revents %08x in socket, terminating\n"),	665	_("FATAL: unknown revents %08x in socket, exiting.\n"),
501	revents);	666	revents);
502	exit (1);	667	exit (EXIT_FAILURE);
503	}	668	}
504	}	669	}
505		670
506	void	671	inline void
507	vpn::tap_ev (io_watcher &w, short revents)	672	vpn::tap_ev (ev::io &w, int revents)
508	{	673	{
509	if (revents & POLLIN)	674	if (revents & EV_READ)
510	{	675	{
511	/* process data */	676	/* process data */
512	tap_packet *pkt;	677	tap_packet *pkt;
513		678
514	pkt = tap->recv ();	679	pkt = tap->recv ();
515		680
		681	if (!pkt)
		682	return;
		683
		684	if (pkt->len > 14)
		685	{
516	int dst = mac2id (pkt->dst);	686	int dst = mac2id (pkt->dst);
517	int src = mac2id (pkt->src);	687	int src = mac2id (pkt->src);
518		688
519	if (src != THISNODE->id)	689	if (src != THISNODE->id)
520	{
521	slog (L_ERR, _("FATAL: tap packet not originating on current node received, terminating."));
522	exit (1);
523	}
524
525	if (dst == THISNODE->id)
526	{
527	slog (L_ERR, _("FATAL: tap packet destined for current node received, terminating."));
528	exit (1);
529	}
530
531	if (dst > conns.size ())
532	slog (L_ERR, _("tap packet for unknown node %d received, ignoring."), dst);
533	else
534	{
535	if (dst)
536	{	690	{
537	// unicast	691	slog (L_ERR, _("FATAL: tap packet not originating on current node received (if-up script not working properly?), exiting."));
538	if (dst != THISNODE->id)	692	exit (EXIT_FAILURE);
539	conns[dst - 1]->inject_data_packet (pkt);
540	}	693	}
		694
		695	if (dst == THISNODE->id)
		696	{
		697	slog (L_ERR, _("FATAL: tap packet destined for current node received, exiting."));
		698	exit (EXIT_FAILURE);
		699	}
		700
		701	if (dst > conns.size ())
		702	slog (L_ERR, _("tap packet for unknown node %d received, ignoring."), dst);
541	else	703	else
542	{
543	// broadcast, first check router, then self, then english
544	connection *router = find_router ();
545
546	if (router)
547	router->inject_data_packet (pkt, true);	704	inject_data_packet (pkt, dst);
548	else
549	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
550	if ((*c)->conf != THISNODE)
551	(*c)->inject_data_packet (pkt);
552	}
553	}	705	}
554		706
555	delete pkt;	707	delete pkt;
556	}
557	else if (revents & (POLLHUP \| POLLERR))
558	{
559	slog (L_ERR, _("FATAL: POLLHUP or POLLERR on network device fd, terminating."));
560	exit (1);
561	}	708	}
562	else	709	else
563	abort ();	710	abort ();
564	}	711	}
565		712
566	void	713	inline void
567	vpn::event_cb (time_watcher &w)	714	vpn::event_cb (ev::timer &w, int)
568	{	715	{
569	if (events)	716	if (events)
570	{	717	{
571	if (events & EVENT_SHUTDOWN)	718	if (events & EVENT_SHUTDOWN)
572	{	719	{
573	slog (L_INFO, _("preparing shutdown..."));	720	slog (L_INFO, _("preparing shutdown..."));
574		721
575	shutdown_all ();	722	shutdown_all ();
576
577	remove_pid (pidfilename);	723	remove_pid (conf.pidfilename);
578
579	slog (L_INFO, _("terminating"));	724	slog (L_INFO, _("exiting."));
580		725	exit (EXIT_SUCCESS);
581	exit (0);
582	}	726	}
583		727
584	if (events & EVENT_RECONNECT)	728	if (events & EVENT_RECONNECT)
585	{	729	{
586	slog (L_INFO, _("forced reconnect"));	730	slog (L_INFO, _("forced reconnect."));
587		731
588	reconnect_all ();	732	reconnect_all ();
589	}	733	}
590		734
591	events = 0;	735	events = 0;
592	}	736	}
593
594	w.at = TSTAMP_CANCEL;
595	}	737	}
596		738
597	void	739	void
598	vpn::shutdown_all ()	740	vpn::shutdown_all ()
599	{	741	{
…		…
609		751
610	conns.clear ();	752	conns.clear ();
611		753
612	connection_init ();	754	connection_init ();
613		755
614	for (configuration::node_vector::iterator i = conf.nodes.begin ();	756	for (configuration::node_vector::iterator i = conf.nodes.begin (); i != conf.nodes.end (); ++i)
615	i != conf.nodes.end (); ++i)	757	conns.push_back (new connection (this, *i));
616	{
617	connection *conn = new connection (this);
618		758
619	conn->conf = *i;	759	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
620	conns.push_back (conn);
621
622	conn->establish_connection ();	760	(*c)->establish_connection ();
623	}
624	}	761	}
625		762
626	connection *vpn::find_router ()	763	bool
		764	vpn::can_direct (conf_node src, conf_node dst) const
627	{	765	{
628	u32 prio = 0;	766	return src != dst
		767	&& src->may_direct (dst)
		768	&& dst->may_direct (src)
		769	&& (((src->protocols & dst->protocols) && src->connectmode == conf_node::C_ALWAYS)
		770	\|\| (src->protocols & dst->connectable_protocols ()));
		771	}
		772
		773	// only works for indirect and routed connections: find a router
		774	// from THISNODE to dst
		775	connection *
		776	vpn::find_router_for (const connection *dst)
		777	{
629	connection *router = 0;	778	connection *router = 0;
630		779
		780	// first try to find a router with a direct connection, route there
		781	// regardless of any other considerations.
		782	{
		783	u32 prio = 1;
		784
		785	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
		786	{
		787	connection c = i;
		788
		789	if (c->conf->routerprio > prio
		790	&& c->conf != THISNODE
		791	&& can_direct (c->conf, dst->conf)
		792	&& c->ictx && c->octx)
		793	{
		794	prio = c->conf->routerprio;
		795	router = c;
		796	}
		797	}
		798	}
		799
		800	if (router)
		801	return router;
		802
		803	// second try find the router with the highest priority, higher than ours
		804	{
		805	u32 prio = THISNODE->routerprio ? THISNODE->routerprio : 1;
		806
		807	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
		808	{
		809	connection c = i;
		810
		811	if (c->conf->routerprio > prio
		812	&& c != dst
		813	&& c->conf != THISNODE
		814	&& c->ictx && c->octx)
		815	{
		816	prio = c->conf->routerprio;
		817	router = c;
		818	}
		819	}
		820	}
		821
		822	return router;
		823	}
		824
		825	void
		826	vpn::connection_established (connection *c)
		827	{
631	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)	828	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
632	{	829	{
633	connection c = i;	830	connection o = i;
634		831
635	if (c->conf->routerprio > prio	832	if (!o->is_direct
636	&& c->connectmode == conf_node::C_ALWAYS	833	&& o->si.valid ()
637	&& c->conf != THISNODE	834	&& c->si != o->si
638	&& c->ictx && c->octx)	835	&& c == find_router_for (o))
639	{
640	prio = c->conf->routerprio;
641	router = c;
642	}	836	{
		837	slog (L_DEBUG, _("%s: can now route packets via %s, re-keying connection."),
		838	o->conf->nodename, c->conf->nodename);
		839	o->rekey ();
		840	}
643	}	841	}
644
645	return router;
646	}	842	}
647		843
		844	void
648	void vpn::send_connect_request (int id)	845	vpn::send_connect_request (connection *c)
649	{	846	{
650	connection *c = find_router ();	847	connection *r = find_router_for (c);
651		848
652	if (c)	849	if (r)
		850	{
		851	slog (L_TRACE, _("%s: no address known, sending mediated connection request via %s."),
		852	c->conf->nodename, r->conf->nodename);
653	c->send_connect_request (id);	853	r->send_connect_request (c->conf->id);
		854	}
654	else	855	else
655	// no router found, aggressively connect to all routers	856	slog (L_DEBUG, _("%s: no way to connect and no router found: unable to connect at this time."),
656	for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)	857	c->conf->nodename);
657	if ((*i)->conf->routerprio)
658	(*i)->establish_connection ();
659	}	858	}
660		859
661	void	860	void
662	connection::dump_status ()	861	connection::dump_status ()
663	{	862	{
664	slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);	863	slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);
665	slog (L_NOTICE, _(" connectmode %d (%d) / sockaddr %s / minor %d"),	864	slog (L_NOTICE, _(" connectmode %d (%d) / sockaddr %s / minor %d"),
666	connectmode, conf->connectmode, (const char *)si, (int)prot_minor);	865	connectmode, conf->connectmode, (const char *)si, (int)prot_minor);
667	slog (L_NOTICE, _(" ictx/octx %08lx/%08lx / oseqno %d / retry_cnt %d"),	866	slog (L_NOTICE, _(" ictx/octx %08lx/%08lx / oseqno %d / retry_cnt %d"),
668	(long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);	867	(long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);
669	slog (L_NOTICE, _(" establish_conn %ld / rekey %ld / keepalive %ld"),
670	(long)(establish_connection.at), (long)(rekey.at), (long)(keepalive.at));
671	}	868	}
672		869
673	void	870	void
674	vpn::dump_status ()	871	vpn::dump_status ()
675	{	872	{
676	slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)NOW);	873	slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)ev_now ());
677		874
678	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)	875	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
679	(*c)->dump_status ();	876	(*c)->dump_status ();
680		877
681	slog (L_NOTICE, _("END status dump"));	878	slog (L_NOTICE, _("END status dump"));
682	}	879	}
683		880
684	vpn::vpn (void)	881	vpn::vpn (void)
		882	{
685	: event (this, &vpn::event_cb)	883	event .set<vpn, &vpn::event_cb > (this);
686	, udpv4_ev_watcher (this, &vpn::udpv4_ev)	884	udpv4_ev_watcher .set<vpn, &vpn::udpv4_ev > (this);
687	, ipv4_ev_watcher (this, &vpn::ipv4_ev)	885	ipv4_ev_watcher .set<vpn, &vpn::ipv4_ev > (this);
688	#if ENABLE_TCP	886	#if ENABLE_TCP
689	, tcpv4_ev_watcher (this, &vpn::tcpv4_ev)	887	tcpv4_ev_watcher .set<vpn, &vpn::tcpv4_ev > (this);
690	#endif	888	#endif
691	#if ENABLE_ICMP	889	#if ENABLE_ICMP
692	, icmpv4_ev_watcher(this, &vpn::icmpv4_ev)	890	icmpv4_ev_watcher.set<vpn, &vpn::icmpv4_ev> (this);
693	#endif	891	#endif
694	, tap_ev_watcher (this, &vpn::tap_ev)	892	#if ENABLE_DNS
695	{	893	dnsv4_ev_watcher .set<vpn, &vpn::dnsv4_ev > (this);
		894	#endif
		895	tap_ev_watcher .set<vpn, &vpn::tap_ev > (this);
696	}	896	}
697		897
698	vpn::~vpn ()	898	vpn::~vpn ()
699	{	899	{
700	}	900	}

Diff Legend

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

Comparing gvpe/src/vpn.C (file contents): Revision 1.9 by pcg, Tue Apr 8 02:00:54 2003 UTC vs. Revision 1.56 by root, Tue Feb 8 23:11:36 2011 UTC

Diff Legend

Comparing gvpe/src/vpn.C (file contents):
Revision 1.9 by pcg, Tue Apr 8 02:00:54 2003 UTC vs.
Revision 1.56 by root, Tue Feb 8 23:11:36 2011 UTC