ViewVC Help

View File | Revision Log | Show Annotations | Download File

/cvs/gvpe/src/connection.C

Comparing gvpe/src/connection.C (file contents):
Revision 1.6 by pcg, Sat Apr 5 02:32:40 2003 UTC vs.
Revision 1.73 by pcg, Sun Aug 10 01:34:36 2008 UTC

1	/*	1	/*
2	connection.C -- manage a single connection	2	connection.C -- manage a single connection
		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	extern "C" {
22	# include "lzf/lzf.h"
23	}
24
25	#include <list>	34	#include <list>
		35	#include <queue>
		36	#include <utility>
26		37
27	#include <openssl/rand.h>	38	#include <openssl/rand.h>
28	#include <openssl/evp.h>	39	#include <openssl/evp.h>
29	#include <openssl/rsa.h>	40	#include <openssl/rsa.h>
30	#include <openssl/err.h>	41	#include <openssl/err.h>
31
32	#include "gettext.h"
33		42
34	#include "conf.h"	43	#include "conf.h"
35	#include "slog.h"	44	#include "slog.h"
36	#include "device.h"	45	#include "device.h"
37	#include "vpn.h"	46	#include "vpn.h"
38	#include "connection.h"	47	#include "connection.h"
39		48
		49	#include "netcompat.h"
		50
40	#if !HAVE_RAND_PSEUDO_BYTES	51	#if !HAVE_RAND_PSEUDO_BYTES
41	# define RAND_pseudo_bytes RAND_bytes	52	# define RAND_pseudo_bytes RAND_bytes
42	#endif	53	#endif
43		54
44	#define MAGIC "vped\xbd\xc6\xdb\x82" // 8 bytes of magic	55	#define MAGIC "vped\xbd\xc6\xdb\x82" // 8 bytes of magic
45		56
		57	#define ULTRA_FAST 1
		58	#define HLOG 15
		59	#include "lzf/lzf.h"
		60	#include "lzf/lzf_c.c"
		61	#include "lzf/lzf_d.c"
		62
		63	//////////////////////////////////////////////////////////////////////////////
		64
		65	static std::queue< std::pair<run_script_cb *, const char *> > rs_queue;
		66	static ev::child rs_child_ev;
		67
		68	void // c++ requires external linkage here, apparently :(
		69	rs_child_cb (ev::child &w, int revents)
		70	{
		71	w.stop ();
		72
		73	if (rs_queue.empty ())
		74	return;
		75
		76	pid_t pid = run_script (*rs_queue.front ().first, false);
		77	if (pid)
		78	{
		79	w.set (pid);
		80	w.start ();
		81	}
		82	else
		83	slog (L_WARN, rs_queue.front ().second);
		84
		85	delete rs_queue.front ().first;
		86	rs_queue.pop ();
		87	}
		88
		89	// despite the fancy name, this is quite a hack
		90	static void
		91	run_script_queued (run_script_cb *cb, const char *warnmsg)
		92	{
		93	rs_queue.push (std::make_pair (cb, warnmsg));
		94
		95	if (!rs_child_ev.is_active ())
		96	{
		97	rs_child_ev.set<rs_child_cb> ();
		98	rs_child_ev ();
		99	}
		100	}
		101
		102	//////////////////////////////////////////////////////////////////////////////
		103
46	struct crypto_ctx	104	struct crypto_ctx
47	{	105	{
48	EVP_CIPHER_CTX cctx;	106	EVP_CIPHER_CTX cctx;
49	HMAC_CTX hctx;	107	HMAC_CTX hctx;
50		108
…		…
53	};	111	};
54		112
55	crypto_ctx::crypto_ctx (const rsachallenge &challenge, int enc)	113	crypto_ctx::crypto_ctx (const rsachallenge &challenge, int enc)
56	{	114	{
57	EVP_CIPHER_CTX_init (&cctx);	115	EVP_CIPHER_CTX_init (&cctx);
58	EVP_CipherInit_ex (&cctx, CIPHER, 0, &challenge[CHG_CIPHER_KEY], 0, enc);	116	require (EVP_CipherInit_ex (&cctx, CIPHER, 0, &challenge[CHG_CIPHER_KEY], 0, enc));
59	HMAC_CTX_init (&hctx);	117	HMAC_CTX_init (&hctx);
60	HMAC_Init_ex (&hctx, &challenge[CHG_HMAC_KEY], HMAC_KEYLEN, DIGEST, 0);	118	HMAC_Init_ex (&hctx, &challenge[CHG_HMAC_KEY], HMAC_KEYLEN, DIGEST, 0);
61	}	119	}
62		120
63	crypto_ctx::~crypto_ctx ()	121	crypto_ctx::~crypto_ctx ()
64	{	122	{
65	EVP_CIPHER_CTX_cleanup (&cctx);	123	require (EVP_CIPHER_CTX_cleanup (&cctx));
66	HMAC_CTX_cleanup (&hctx);	124	HMAC_CTX_cleanup (&hctx);
67	}	125	}
68		126
69	static void	127	static void
70	rsa_hash (const rsaid &id, const rsachallenge &chg, rsaresponse &h)	128	rsa_hash (const rsaid &id, const rsachallenge &chg, rsaresponse &h)
71	{	129	{
72	EVP_MD_CTX ctx;	130	EVP_MD_CTX ctx;
73		131
74	EVP_MD_CTX_init (&ctx);	132	EVP_MD_CTX_init (&ctx);
75	EVP_DigestInit (&ctx, RSA_HASH);	133	require (EVP_DigestInit (&ctx, RSA_HASH));
76	EVP_DigestUpdate(&ctx, &chg, sizeof chg);	134	require (EVP_DigestUpdate(&ctx, &chg, sizeof chg));
77	EVP_DigestUpdate(&ctx, &id, sizeof id);	135	require (EVP_DigestUpdate(&ctx, &id, sizeof id));
78	EVP_DigestFinal (&ctx, (unsigned char *)&h, 0);	136	require (EVP_DigestFinal (&ctx, (unsigned char *)&h, 0));
79	EVP_MD_CTX_cleanup (&ctx);	137	EVP_MD_CTX_cleanup (&ctx);
80	}	138	}
81		139
82	struct rsa_entry {	140	struct rsa_entry
		141	{
83	tstamp expire;	142	tstamp expire;
84	rsaid id;	143	rsaid id;
85	rsachallenge chg;	144	rsachallenge chg;
86	};	145	};
87		146
88	struct rsa_cache : list<rsa_entry>	147	struct rsa_cache : list<rsa_entry>
89	{	148	{
90	void cleaner_cb (time_watcher &w); time_watcher cleaner;	149	inline void cleaner_cb (ev::timer &w, int revents); ev::timer cleaner;
91		150
92	bool find (const rsaid &id, rsachallenge &chg)	151	bool find (const rsaid &id, rsachallenge &chg)
93	{	152	{
94	for (iterator i = begin (); i != end (); ++i)	153	for (iterator i = begin (); i != end (); ++i)
95	{	154	{
96	if (!memcmp (&id, &i->id, sizeof id) && i->expire > NOW)	155	if (!memcmp (&id, &i->id, sizeof id) && i->expire > ev_now ())
97	{	156	{
98	memcpy (&chg, &i->chg, sizeof chg);	157	memcpy (&chg, &i->chg, sizeof chg);
99		158
100	erase (i);	159	erase (i);
101	return true;	160	return true;
102	}	161	}
103	}	162	}
104		163
105	if (cleaner.at < NOW)	164	if (!cleaner.is_active ())
106	cleaner.start (NOW + RSA_TTL);	165	cleaner.again ();
107		166
108	return false;	167	return false;
109	}	168	}
110		169
111	void gen (rsaid &id, rsachallenge &chg)	170	void gen (rsaid &id, rsachallenge &chg)
112	{	171	{
113	rsa_entry e;	172	rsa_entry e;
114		173
115	RAND_bytes ((unsigned char *)&id, sizeof id);	174	RAND_bytes ((unsigned char *)&id, sizeof id);
116	RAND_bytes ((unsigned char *)&chg, sizeof chg);	175	RAND_bytes ((unsigned char *)&chg, sizeof chg);
117		176
118	e.expire = NOW + RSA_TTL;	177	e.expire = ev_now () + RSA_TTL;
119	e.id = id;	178	e.id = id;
120	memcpy (&e.chg, &chg, sizeof chg);	179	memcpy (&e.chg, &chg, sizeof chg);
121		180
122	push_back (e);	181	push_back (e);
123		182
124	if (cleaner.at < NOW)	183	if (!cleaner.is_active ())
125	cleaner.start (NOW + RSA_TTL);	184	cleaner.again ();
126	}	185	}
127		186
128	rsa_cache ()	187	rsa_cache ()
129	: cleaner (this, &rsa_cache::cleaner_cb)	188	{
130	{ }	189	cleaner.set<rsa_cache, &rsa_cache::cleaner_cb> (this);
		190	cleaner.set (RSA_TTL, RSA_TTL);
		191	}
131		192
132	} rsa_cache;	193	} rsa_cache;
133		194
134	void rsa_cache::cleaner_cb (time_watcher &w)	195	void rsa_cache::cleaner_cb (ev::timer &w, int revents)
135	{	196	{
136	if (empty ())	197	if (empty ())
137	w.at = TSTAMP_CANCEL;	198	w.stop ();
138	else	199	else
139	{	200	{
140	w.at = NOW + RSA_TTL;
141
142	for (iterator i = begin (); i != end (); )	201	for (iterator i = begin (); i != end (); )
143	if (i->expire <= NOW)	202	if (i->expire <= ev_now ())
144	i = erase (i);	203	i = erase (i);
145	else	204	else
146	++i;	205	++i;
147	}	206	}
148	}	207	}
149		208
150	//////////////////////////////////////////////////////////////////////////////	209	//////////////////////////////////////////////////////////////////////////////
151		210
152	void pkt_queue::put (tap_packet *p)	211	pkt_queue::pkt_queue (double max_ttl, int max_queue)
		212	: max_ttl (max_ttl), max_queue (max_queue)
153	{	213	{
154	if (queue[i])	214	queue = new pkt [max_queue];
155	{
156	delete queue[i];
157	j = (j + 1) % QUEUEDEPTH;
158	}
159		215
160	queue[i] = p;
161
162	i = (i + 1) % QUEUEDEPTH;
163	}
164
165	tap_packet *pkt_queue::get ()
166	{
167	tap_packet *p = queue[j];
168
169	if (p)
170	{
171	queue[j] = 0;
172	j = (j + 1) % QUEUEDEPTH;
173	}
174
175	return p;
176	}
177
178	pkt_queue::pkt_queue ()
179	{
180	memset (queue, 0, sizeof (queue));
181	i = 0;	216	i = 0;
182	j = 0;	217	j = 0;
		218
		219	expire.set<pkt_queue, &pkt_queue::expire_cb> (this);
183	}	220	}
184		221
185	pkt_queue::~pkt_queue ()	222	pkt_queue::~pkt_queue ()
186	{	223	{
187	for (i = QUEUEDEPTH; --i > 0; )	224	while (net_packet *p = get ())
		225	delete p;
		226
188	delete queue[i];	227	delete [] queue;
189	}	228	}
190		229
		230	void pkt_queue::expire_cb (ev::timer &w, int revents)
		231	{
		232	ev_tstamp expire = ev_now () - max_ttl;
		233
		234	for (;;)
		235	{
		236	if (empty ())
		237	break;
		238
		239	double diff = queue[j].tstamp - expire;
		240
		241	if (diff >= 0.)
		242	{
		243	w.start (diff > 0.5 ? diff : 0.5);
		244	break;
		245	}
		246
		247	delete get ();
		248	}
		249	}
		250
		251	void pkt_queue::put (net_packet *p)
		252	{
		253	ev_tstamp now = ev_now ();
		254
		255	// start expiry timer
		256	if (empty ())
		257	expire.start (max_ttl);
		258
		259	int ni = i + 1 == max_queue ? 0 : i + 1;
		260
		261	if (ni == j)
		262	delete get ();
		263
		264	queue[i].pkt = p;
		265	queue[i].tstamp = now;
		266
		267	i = ni;
		268	}
		269
		270	net_packet *pkt_queue::get ()
		271	{
		272	if (empty ())
		273	return 0;
		274
		275	net_packet *p = queue[j].pkt;
		276	queue[j].pkt = 0;
		277
		278	j = j + 1 == max_queue ? 0 : j + 1;
		279
		280	return p;
		281	}
		282
191	struct net_rateinfo {	283	struct net_rateinfo
		284	{
192	u32 host;	285	u32 host;
193	double pcnt, diff;	286	double pcnt, diff;
194	tstamp last;	287	tstamp last;
195	};	288	};
196		289
197	// only do action once every x seconds per host whole allowing bursts.	290	// only do action once every x seconds per host whole allowing bursts.
198	// this implementation ("splay list" ;) is inefficient,	291	// this implementation ("splay list" ;) is inefficient,
199	// but low on resources.	292	// but low on resources.
200	struct net_rate_limiter : list<net_rateinfo>	293	struct net_rate_limiter : list<net_rateinfo>
201	{	294	{
202	static const double ALPHA = 1. - 1. / 90.; // allow bursts	295	# define NRL_ALPHA (1. - 1. / 600.) // allow bursts
203	static const double CUTOFF = 20.; // one event every CUTOFF seconds	296	# define NRL_CUTOFF 10. // one event every CUTOFF seconds
204	static const double EXPIRE = CUTOFF * 30.; // expire entries after this time	297	# define NRL_EXPIRE (NRL_CUTOFF * 30.) // expire entries after this time
		298	# define NRL_MAXDIF (NRL_CUTOFF * (1. / (1. - NRL_ALPHA))) // maximum diff /count value
205		299
206	bool can (const sockinfo &si) { return can((u32)si.host); }	300	bool can (const sockinfo &si) { return can((u32)si.host); }
207	bool can (u32 host);	301	bool can (u32 host);
208	};	302	};
209		303
210	net_rate_limiter auth_rate_limiter, reset_rate_limiter;	304	net_rate_limiter auth_rate_limiter, reset_rate_limiter;
211		305
…		…
214	iterator i;	308	iterator i;
215		309
216	for (i = begin (); i != end (); )	310	for (i = begin (); i != end (); )
217	if (i->host == host)	311	if (i->host == host)
218	break;	312	break;
219	else if (i->last < NOW - EXPIRE)	313	else if (i->last < ev_now () - NRL_EXPIRE)
220	i = erase (i);	314	i = erase (i);
221	else	315	else
222	i++;	316	i++;
223		317
224	if (i == end ())	318	if (i == end ())
225	{	319	{
226	net_rateinfo ri;	320	net_rateinfo ri;
227		321
228	ri.host = host;	322	ri.host = host;
229	ri.pcnt = 1.;	323	ri.pcnt = 1.;
230	ri.diff = CUTOFF * (1. / (1. - ALPHA));	324	ri.diff = NRL_MAXDIF;
231	ri.last = NOW;	325	ri.last = ev_now ();
232		326
233	push_front (ri);	327	push_front (ri);
234		328
235	return true;	329	return true;
236	}	330	}
237	else	331	else
238	{	332	{
239	net_rateinfo ri (*i);	333	net_rateinfo ri (*i);
240	erase (i);	334	erase (i);
241		335
242	ri.pcnt = ri.pcnt * ALPHA;	336	ri.pcnt = ri.pcnt * NRL_ALPHA;
243	ri.diff = ri.diff * ALPHA + (NOW - ri.last);	337	ri.diff = ri.diff * NRL_ALPHA + (ev_now () - ri.last);
244		338
245	ri.last = NOW;	339	ri.last = ev_now ();
246		340
		341	double dif = ri.diff / ri.pcnt;
		342
247	bool send = ri.diff / ri.pcnt > CUTOFF;	343	bool send = dif > NRL_CUTOFF;
248		344
		345	if (dif > NRL_MAXDIF)
		346	{
		347	ri.pcnt = 1.;
		348	ri.diff = NRL_MAXDIF;
		349	}
249	if (send)	350	else if (send)
250	ri.pcnt++;	351	ri.pcnt++;
251		352
252	push_front (ri);	353	push_front (ri);
253		354
254	return send;	355	return send;
…		…
299	}	400	}
300		401
301	#define MAXVPNDATA (MAX_MTU - 6 - 6)	402	#define MAXVPNDATA (MAX_MTU - 6 - 6)
302	#define DATAHDR (sizeof (u32) + RAND_SIZE)	403	#define DATAHDR (sizeof (u32) + RAND_SIZE)
303		404
304	struct vpndata_packet:vpn_packet	405	struct vpndata_packet : vpn_packet
305	{	406	{
306	u8 data[MAXVPNDATA + DATAHDR]; // seqno	407	u8 data[MAXVPNDATA + DATAHDR]; // seqno
307		408
308	void setup (connection *conn, int dst, u8 *d, u32 len, u32 seqno);	409	void setup (connection *conn, int dst, u8 *d, u32 len, u32 seqno);
309	tap_packet *unpack (connection *conn, u32 &seqno);	410	tap_packet *unpack (connection *conn, u32 &seqno);
…		…
322	int outl = 0, outl2;	423	int outl = 0, outl2;
323	ptype type = PT_DATA_UNCOMPRESSED;	424	ptype type = PT_DATA_UNCOMPRESSED;
324		425
325	#if ENABLE_COMPRESSION	426	#if ENABLE_COMPRESSION
326	u8 cdata[MAX_MTU];	427	u8 cdata[MAX_MTU];
327	u32 cl;
328		428
		429	if (conn->features & ENABLE_COMPRESSION)
		430	{
329	cl = lzf_compress (d, l, cdata + 2, (l - 2) & ~7);	431	u32 cl = lzf_compress (d, l, cdata + 2, (l - 2) & ~7);
		432
330	if (cl)	433	if (cl)
331	{	434	{
332	type = PT_DATA_COMPRESSED;	435	type = PT_DATA_COMPRESSED;
333	d = cdata;	436	d = cdata;
334	l = cl + 2;	437	l = cl + 2;
335		438
336	d[0] = cl >> 8;	439	d[0] = cl >> 8;
337	d[1] = cl;	440	d[1] = cl;
		441	}
338	}	442	}
339	#endif	443	#endif
340		444
341	EVP_EncryptInit_ex (cctx, 0, 0, 0, 0);	445	require (EVP_EncryptInit_ex (cctx, 0, 0, 0, 0));
342		446
343	struct {	447	struct {
344	#if RAND_SIZE	448	#if RAND_SIZE
345	u8 rnd[RAND_SIZE];	449	u8 rnd[RAND_SIZE];
346	#endif	450	#endif
…		…
350	datahdr.seqno = ntohl (seqno);	454	datahdr.seqno = ntohl (seqno);
351	#if RAND_SIZE	455	#if RAND_SIZE
352	RAND_pseudo_bytes ((unsigned char *) datahdr.rnd, RAND_SIZE);	456	RAND_pseudo_bytes ((unsigned char *) datahdr.rnd, RAND_SIZE);
353	#endif	457	#endif
354		458
355	EVP_EncryptUpdate (cctx,	459	require (EVP_EncryptUpdate (cctx,
356	(unsigned char *) data + outl, &outl2,	460	(unsigned char *) data + outl, &outl2,
357	(unsigned char *) &datahdr, DATAHDR);	461	(unsigned char *) &datahdr, DATAHDR));
358	outl += outl2;	462	outl += outl2;
359		463
360	EVP_EncryptUpdate (cctx,	464	require (EVP_EncryptUpdate (cctx,
361	(unsigned char *) data + outl, &outl2,	465	(unsigned char *) data + outl, &outl2,
362	(unsigned char *) d, l);	466	(unsigned char *) d, l));
363	outl += outl2;	467	outl += outl2;
364		468
365	EVP_EncryptFinal_ex (cctx, (unsigned char *) data + outl, &outl2);	469	require (EVP_EncryptFinal_ex (cctx, (unsigned char *) data + outl, &outl2));
366	outl += outl2;	470	outl += outl2;
367		471
368	len = outl + data_hdr_size ();	472	len = outl + data_hdr_size ();
369		473
370	set_hdr (type, dst);	474	set_hdr (type, dst);
…		…
379	int outl = 0, outl2;	483	int outl = 0, outl2;
380	tap_packet *p = new tap_packet;	484	tap_packet *p = new tap_packet;
381	u8 *d;	485	u8 *d;
382	u32 l = len - data_hdr_size ();	486	u32 l = len - data_hdr_size ();
383		487
384	EVP_DecryptInit_ex (cctx, 0, 0, 0, 0);	488	require (EVP_DecryptInit_ex (cctx, 0, 0, 0, 0));
385		489
386	#if ENABLE_COMPRESSION	490	#if ENABLE_COMPRESSION
387	u8 cdata[MAX_MTU];	491	u8 cdata[MAX_MTU];
388		492
389	if (type == PT_DATA_COMPRESSED)	493	if (type == PT_DATA_COMPRESSED)
…		…
391	else	495	else
392	#endif	496	#endif
393	d = &(*p)[6 + 6 - DATAHDR];	497	d = &(*p)[6 + 6 - DATAHDR];
394		498
395	/* this overwrites part of the src mac, but we fix that later */	499	/* this overwrites part of the src mac, but we fix that later */
396	EVP_DecryptUpdate (cctx,	500	require (EVP_DecryptUpdate (cctx,
397	d, &outl2,	501	d, &outl2,
398	(unsigned char *)&data, len - data_hdr_size ());	502	(unsigned char *)&data, len - data_hdr_size ()));
399	outl += outl2;	503	outl += outl2;
400		504
401	EVP_DecryptFinal_ex (cctx, (unsigned char *)d + outl, &outl2);	505	require (EVP_DecryptFinal_ex (cctx, (unsigned char *)d + outl, &outl2));
402	outl += outl2;	506	outl += outl2;
403		507
404	seqno = ntohl (*(u32 *)(d + RAND_SIZE));	508	seqno = ntohl (*(u32 *)(d + RAND_SIZE));
405		509
406	id2mac (dst () ? dst() : THISNODE->id, p->dst);	510	id2mac (dst () ? dst() : THISNODE->id, p->dst);
…		…
435	{	539	{
436	// actually, hmaclen cannot be checked because the hmac	540	// actually, hmaclen cannot be checked because the hmac
437	// field comes before this data, so peers with other	541	// field comes before this data, so peers with other
438	// hmacs simply will not work.	542	// hmacs simply will not work.
439	u8 prot_major, prot_minor, randsize, hmaclen;	543	u8 prot_major, prot_minor, randsize, hmaclen;
440	u8 flags, challengelen, pad2, pad3;	544	u8 flags, challengelen, features, pad3;
441	u32 cipher_nid, digest_nid, hmac_nid;	545	u32 cipher_nid, digest_nid, hmac_nid;
442
443	const u8 curflags () const
444	{
445	return 0x80
446	| (ENABLE_COMPRESSION ? 0x01 : 0x00);
447	}
448		546
449	void setup (ptype type, int dst);	547	void setup (ptype type, int dst);
450	bool chk_config () const;	548	bool chk_config () const;
		549
		550	static u8 get_features ()
		551	{
		552	u8 f = 0;
		553	#if ENABLE_COMPRESSION
		554	f |= FEATURE_COMPRESSION;
		555	#endif
		556	#if ENABLE_ROHC
		557	f |= FEATURE_ROHC;
		558	#endif
		559	#if ENABLE_BRIDGING
		560	f |= FEATURE_BRIDGING;
		561	#endif
		562	return f;
		563	}
451	};	564	};
452		565
453	void config_packet::setup (ptype type, int dst)	566	void config_packet::setup (ptype type, int dst)
454	{	567	{
455	prot_major = PROTOCOL_MAJOR;	568	prot_major = PROTOCOL_MAJOR;
456	prot_minor = PROTOCOL_MINOR;	569	prot_minor = PROTOCOL_MINOR;
457	randsize = RAND_SIZE;	570	randsize = RAND_SIZE;
458	hmaclen = HMACLENGTH;	571	hmaclen = HMACLENGTH;
459	flags = curflags ();	572	flags = 0;
460	challengelen = sizeof (rsachallenge);	573	challengelen = sizeof (rsachallenge);
		574	features = get_features ();
461		575
462	cipher_nid = htonl (EVP_CIPHER_nid (CIPHER));	576	cipher_nid = htonl (EVP_CIPHER_nid (CIPHER));
463	digest_nid = htonl (EVP_MD_type (RSA_HASH));	577	digest_nid = htonl (EVP_MD_type (RSA_HASH));
464	hmac_nid = htonl (EVP_MD_type (DIGEST));	578	hmac_nid = htonl (EVP_MD_type (DIGEST));
465		579
…		…
467	set_hdr (type, dst);	581	set_hdr (type, dst);
468	}	582	}
469		583
470	bool config_packet::chk_config () const	584	bool config_packet::chk_config () const
471	{	585	{
472	return prot_major == PROTOCOL_MAJOR	586	if (prot_major != PROTOCOL_MAJOR)
473	&& randsize == RAND_SIZE	587	slog (L_WARN, _("major version mismatch (remote %d <=> local %d)"), prot_major, PROTOCOL_MAJOR);
474	&& hmaclen == HMACLENGTH	588	else if (randsize != RAND_SIZE)
475	&& flags == curflags ()	589	slog (L_WARN, _("rand size mismatch (remote %d <=> local %d)"), randsize, RAND_SIZE);
		590	else if (hmaclen != HMACLENGTH)
		591	slog (L_WARN, _("hmac length mismatch (remote %d <=> local %d)"), hmaclen, HMACLENGTH);
476	&& challengelen == sizeof (rsachallenge)	592	else if (challengelen != sizeof (rsachallenge))
		593	slog (L_WARN, _("challenge length mismatch (remote %d <=> local %d)"), challengelen, sizeof (rsachallenge));
477	&& cipher_nid == htonl (EVP_CIPHER_nid (CIPHER))	594	else if (cipher_nid != htonl (EVP_CIPHER_nid (CIPHER)))
		595	slog (L_WARN, _("cipher mismatch (remote %x <=> local %x)"), ntohl (cipher_nid), EVP_CIPHER_nid (CIPHER));
478	&& digest_nid == htonl (EVP_MD_type (RSA_HASH))	596	else if (digest_nid != htonl (EVP_MD_type (RSA_HASH)))
		597	slog (L_WARN, _("digest mismatch (remote %x <=> local %x)"), ntohl (digest_nid), EVP_MD_type (RSA_HASH));
479	&& hmac_nid == htonl (EVP_MD_type (DIGEST));	598	else if (hmac_nid != htonl (EVP_MD_type (DIGEST)))
		599	slog (L_WARN, _("hmac mismatch (remote %x <=> local %x)"), ntohl (hmac_nid), EVP_MD_type (DIGEST));
		600	else
		601	return true;
		602
		603	return false;
480	}	604	}
481		605
482	struct auth_req_packet : config_packet	606	struct auth_req_packet : config_packet
483	{	607	{
484	char magic[8];	608	char magic[8];
485	u8 initiate; // false if this is just an automatic reply	609	u8 initiate; // false if this is just an automatic reply
486	u8 protocols; // supported protocols (will get patches on forward)	610	u8 protocols; // supported protocols (will be patched on forward)
487	u8 pad2, pad3;	611	u8 pad2, pad3;
488	rsaid id;	612	rsaid id;
489	rsaencrdata encr;	613	rsaencrdata encr;
490		614
491	auth_req_packet (int dst, bool initiate_, u8 protocols_)	615	auth_req_packet (int dst, bool initiate_, u8 protocols_)
…		…
546	};	670	};
547		671
548	/////////////////////////////////////////////////////////////////////////////	672	/////////////////////////////////////////////////////////////////////////////
549		673
550	void	674	void
		675	connection::connection_established ()
		676	{
		677	slog (L_TRACE, _("%s: possible connection establish (ictx %d, octx %d)"), conf->nodename, !!ictx, !!octx);
		678
		679	if (ictx && octx)
		680	{
		681	// make sure rekeying timeouts are slightly asymmetric
		682	ev::tstamp rekey_interval = ::conf.rekey + (conf->id > THISNODE->id ? 10 : 0);
		683	rekey.start (rekey_interval, rekey_interval);
		684	keepalive.start (::conf.keepalive);
		685
		686	// send queued packets
		687	if (ictx && octx)
		688	{
		689	while (tap_packet *p = (tap_packet *)data_queue.get ())
		690	{
		691	if (p->len) send_data_packet (p);
		692	delete p;
		693	}
		694
		695	while (vpn_packet *p = (vpn_packet *)vpn_queue.get ())
		696	{
		697	if (p->len) send_vpn_packet (p, si, IPTOS_RELIABILITY);
		698	delete p;
		699	}
		700	}
		701
		702	vpn->connection_established (this);
		703	}
		704	else
		705	{
		706	retry_cnt = 0;
		707	establish_connection.start (5);
		708	keepalive.stop ();
		709	rekey.stop ();
		710	}
		711	}
		712
		713	void
551	connection::reset_dstaddr ()	714	connection::reset_si ()
552	{	715	{
		716	if (vpn->can_direct (THISNODE, conf))
553	protocol = best_protocol (THISNODE->protocols & conf->protocols);	717	protocol = best_protocol (THISNODE->protocols & conf->connectable_protocols ());
554		718	else
555	// mask out protocols we cannot establish	719	{
556	if (!conf->udp_port) protocol &= ~PROT_UDPv4;	720	slog (L_TRACE, _("%s: direct connection denied by config."), conf->nodename);
557	if (!conf->tcp_port) protocol &= ~PROT_TCPv4;	721	protocol = 0;
		722	}
558		723
559	si.set (conf, protocol);	724	si.set (conf, protocol);
560	}
561		725
562	void	726	is_direct = si.valid ();
563	connection::send_ping (const sockinfo &si, u8 pong)
564	{
565	ping_packet *pkt = new ping_packet;
566
567	pkt->setup (conf->id, pong ? ping_packet::PT_PONG : ping_packet::PT_PING);
568	vpn->send_vpn_packet (pkt, si, IPTOS_LOWDELAY);
569
570	delete pkt;
571	}	727	}
572		728
573	void	729	// ensure sockinfo is valid, forward if necessary
		730	const sockinfo &
574	connection::send_reset (const sockinfo &si)	731	connection::forward_si (const sockinfo &si) const
575	{	732	{
576	if (reset_rate_limiter.can (si) && connectmode != conf_node::C_DISABLED)	733	if (!si.valid ())
577	{
578	config_packet *pkt = new config_packet;
579
580	pkt->setup (vpn_packet::PT_RESET, conf->id);
581	vpn->send_vpn_packet (pkt, si, IPTOS_MINCOST);
582
583	delete pkt;
584	}	734	{
585	}	735	connection *r = vpn->find_router_for (this);
586		736
587	void	737	if (r)
588	connection::send_auth_request (const sockinfo &si, bool initiate)
589	{
590	auth_req_packet *pkt = new auth_req_packet (conf->id, initiate, THISNODE->protocols);
591
592	rsachallenge chg;
593
594	rsa_cache.gen (pkt->id, chg);
595
596	if (0 > RSA_public_encrypt (sizeof chg,
597	(unsigned char *)&chg, (unsigned char *)&pkt->encr,
598	conf->rsa_key, RSA_PKCS1_OAEP_PADDING))
599	fatal ("RSA_public_encrypt error");
600
601	slog (L_TRACE, ">>%d PT_AUTH_REQ [%s]", conf->id, (const char *)si);
602
603	vpn->send_vpn_packet (pkt, si, IPTOS_RELIABILITY); // rsa is very very costly
604
605	delete pkt;
606	}
607
608	void
609	connection::send_auth_response (const sockinfo &si, const rsaid &id, const rsachallenge &chg)
610	{
611	auth_res_packet *pkt = new auth_res_packet (conf->id);
612
613	pkt->id = id;
614
615	rsa_hash (id, chg, pkt->response);
616
617	pkt->hmac_set (octx);
618
619	slog (L_TRACE, ">>%d PT_AUTH_RES [%s]", conf->id, (const char *)si);
620
621	vpn->send_vpn_packet (pkt, si, IPTOS_RELIABILITY); // rsa is very very costly
622
623	delete pkt;
624	}
625
626	void
627	connection::send_connect_info (int rid, const sockinfo &rsi, u8 rprotocols)
628	{
629	slog (L_TRACE, ">>%d PT_CONNECT_INFO(%d,%s)\n",
630	conf->id, rid, (const char *)rsi);
631
632	connect_info_packet *r = new connect_info_packet (conf->id, rid, rsi, rprotocols);
633
634	r->hmac_set (octx);
635	vpn->send_vpn_packet (r, si);
636
637	delete r;
638	}
639
640	void
641	connection::establish_connection_cb (time_watcher &w)
642	{
643	if (ictx || conf == THISNODE
644	|| connectmode == conf_node::C_NEVER
645	|| connectmode == conf_node::C_DISABLED)
646	w.at = TSTAMP_CANCEL;
647	else if (w.at <= NOW)
648	{
649	double retry_int = double (retry_cnt & 3 ? (retry_cnt & 3) : 1 << (retry_cnt >> 2)) * 0.6;
650
651	if (retry_int < 3600 * 8)
652	retry_cnt++;
653
654	w.at = NOW + retry_int;
655
656	if (conf->hostname)
657	{	738	{
658	reset_dstaddr ();	739	slog (L_DEBUG, _("%s: no common protocol, trying to route through %s."),
659		740	conf->nodename, r->conf->nodename);
660	if (si.valid () && auth_rate_limiter.can (si))	741	return r->si;
661	{
662	if (retry_cnt < 4)
663	send_auth_request (si, true);
664	else
665	send_ping (si, 0);
666	}
667	}	742	}
668	else	743	else
		744	slog (L_DEBUG, _("%s: node unreachable, no common protocol or no router available."),
		745	conf->nodename);
		746	}
		747
		748	return si;
		749	}
		750
		751	void
		752	connection::send_vpn_packet (vpn_packet *pkt, const sockinfo &si, int tos)
		753	{
		754	if (!vpn->send_vpn_packet (pkt, si, tos))
		755	reset_connection ();
		756	}
		757
		758	void
		759	connection::send_ping (const sockinfo &si, u8 pong)
		760	{
		761	ping_packet *pkt = new ping_packet;
		762
		763	pkt->setup (conf->id, pong ? ping_packet::PT_PONG : ping_packet::PT_PING);
		764
		765	slog (L_TRACE, ">>%d %s [%s]", conf->id, pong ? "PT_PONG" : "PT_PING", (const char *)si);
		766
		767	send_vpn_packet (pkt, si, IPTOS_LOWDELAY);
		768
		769	delete pkt;
		770	}
		771
		772	void
		773	connection::send_reset (const sockinfo &si)
		774	{
		775	if (reset_rate_limiter.can (si) && connectmode != conf_node::C_DISABLED)
		776	{
		777	config_packet *pkt = new config_packet;
		778
		779	pkt->setup (vpn_packet::PT_RESET, conf->id);
		780	send_vpn_packet (pkt, si, IPTOS_MINCOST);
		781
		782	delete pkt;
		783	}
		784	}
		785
		786	void
		787	connection::send_auth_request (const sockinfo &si, bool initiate)
		788	{
		789	auth_req_packet *pkt = new auth_req_packet (conf->id, initiate, THISNODE->protocols);
		790
		791	rsachallenge chg;
		792	rsa_cache.gen (pkt->id, chg);
		793	rsa_encrypt (conf->rsa_key, chg, pkt->encr);
		794
		795	slog (L_TRACE, ">>%d PT_AUTH_REQ [%s]", conf->id, (const char *)si);
		796
		797	send_vpn_packet (pkt, si, IPTOS_RELIABILITY | IPTOS_LOWDELAY); // rsa is very very costly
		798
		799	delete pkt;
		800	}
		801
		802	void
		803	connection::send_auth_response (const sockinfo &si, const rsaid &id, const rsachallenge &chg)
		804	{
		805	auth_res_packet *pkt = new auth_res_packet (conf->id);
		806
		807	pkt->id = id;
		808
		809	rsa_hash (id, chg, pkt->response);
		810
		811	pkt->hmac_set (octx);
		812
		813	slog (L_TRACE, ">>%d PT_AUTH_RES [%s]", conf->id, (const char *)si);
		814
		815	send_vpn_packet (pkt, si, IPTOS_RELIABILITY); // rsa is very very costly
		816
		817	delete pkt;
		818	}
		819
		820	void
		821	connection::send_connect_info (int rid, const sockinfo &rsi, u8 rprotocols)
		822	{
		823	slog (L_TRACE, ">>%d PT_CONNECT_INFO(%d,%s)",
		824	conf->id, rid, (const char *)rsi);
		825
		826	connect_info_packet *r = new connect_info_packet (conf->id, rid, rsi, rprotocols);
		827
		828	r->hmac_set (octx);
		829	send_vpn_packet (r, si);
		830
		831	delete r;
		832	}
		833
		834	inline void
		835	connection::establish_connection_cb (ev::timer &w, int revents)
		836	{
		837	if (!ictx
		838	&& conf != THISNODE
		839	&& connectmode != conf_node::C_NEVER
		840	&& connectmode != conf_node::C_DISABLED
		841	&& !w.is_active ())
		842	{
		843	// a bit hacky, if ondemand, and packets are no longer queued, then reset the connection
		844	// and stop trying. should probably be handled by a per-connection expire handler.
		845	if (connectmode == conf_node::C_ONDEMAND && vpn_queue.empty () && data_queue.empty ())
		846	{
		847	reset_connection ();
		848	return;
		849	}
		850
		851	last_establish_attempt = ev_now ();
		852
		853	ev::tstamp retry_int = ev::tstamp (retry_cnt & 3
		854	? (retry_cnt & 3) + 1
		855	: 1 << (retry_cnt >> 2));
		856
		857	reset_si ();
		858
		859	bool slow = si.prot & PROT_SLOW;
		860
		861	if (si.prot && !si.host && vpn->can_direct (THISNODE, conf))
		862	{
		863	/*TODO*/ /* start the timer so we don't recurse endlessly */
		864	w.start (1);
669	vpn->connect_request (conf->id);	865	vpn->send_connect_request (conf->id);
		866	}
		867	else
		868	{
		869	if (si.valid ())
		870	slog (L_DEBUG, _("%s: sending direct connection request to %s."),
		871	conf->nodename, (const char *)si);
		872
		873	const sockinfo &dsi = forward_si (si);
		874
		875	slow = slow || (dsi.prot & PROT_SLOW);
		876
		877	if (dsi.valid () && auth_rate_limiter.can (dsi))
		878	{
		879	if (retry_cnt < 4)
		880	send_auth_request (dsi, true);
		881	else
		882	send_ping (dsi, 0);
		883	}
		884	}
		885
		886	retry_int *= slow ? 8. : 0.9;
		887
		888	if (retry_int < conf->max_retry)
		889	retry_cnt++;
		890	else
		891	retry_int = conf->max_retry;
		892
		893	w.start (retry_int);
670	}	894	}
671	}	895	}
672		896
673	void	897	void
674	connection::reset_connection ()	898	connection::reset_connection ()
…		…
677	{	901	{
678	slog (L_INFO, _("%s(%s): connection lost"),	902	slog (L_INFO, _("%s(%s): connection lost"),
679	conf->nodename, (const char *)si);	903	conf->nodename, (const char *)si);
680		904
681	if (::conf.script_node_down)	905	if (::conf.script_node_down)
682	run_script (run_script_cb (this, &connection::script_node_down), false);	906	{
		907	run_script_cb *cb = new run_script_cb;
		908	cb->set<connection, &connection::script_node_down> (this);
		909	run_script_queued (cb, _("node-down command execution failed, continuing."));
		910	}
683	}	911	}
684		912
685	delete ictx; ictx = 0;	913	delete ictx; ictx = 0;
686	delete octx; octx = 0;	914	delete octx; octx = 0;
		915	#if ENABLE_DNS
		916	dnsv4_reset_connection ();
		917	#endif
687		918
688	si.host= 0;	919	si.host = 0;
689		920
690	last_activity = 0;	921	last_activity = 0.;
		922	//last_si_change = 0.;
691	retry_cnt = 0;	923	retry_cnt = 0;
692		924
693	rekey.reset ();	925	rekey.stop ();
694	keepalive.reset ();	926	keepalive.stop ();
695	establish_connection.reset ();	927	establish_connection.stop ();
696	}	928	}
697		929
698	void	930	void
699	connection::shutdown ()	931	connection::shutdown ()
700	{	932	{
…		…
702	send_reset (si);	934	send_reset (si);
703		935
704	reset_connection ();	936	reset_connection ();
705	}	937	}
706		938
707	void	939	// poor-man's rekeying
708	connection::rekey_cb (time_watcher &w)	940	inline void
		941	connection::rekey_cb (ev::timer &w, int revents)
709	{	942	{
710	w.at = TSTAMP_CANCEL;
711
712	reset_connection ();	943	reset_connection ();
713	establish_connection ();	944	establish_connection ();
714	}	945	}
715		946
716	void	947	void
717	connection::send_data_packet (tap_packet *pkt, bool broadcast)	948	connection::send_data_packet (tap_packet *pkt)
718	{	949	{
719	vpndata_packet *p = new vpndata_packet;	950	vpndata_packet *p = new vpndata_packet;
720	int tos = 0;	951	int tos = 0;
721		952
722	if (conf->inherit_tos	953	// I am not hilarious about peeking into packets, but so be it.
723	&& (*pkt)[12] == 0x08 && (*pkt)[13] == 0x00 // IP	954	if (conf->inherit_tos && pkt->is_ipv4 ())
724	&& ((*pkt)[14] & 0xf0) == 0x40) // IPv4
725	tos = (*pkt)[15] & IPTOS_TOS_MASK;	955	tos = (*pkt)[15] & IPTOS_TOS_MASK;
726		956
727	p->setup (this, broadcast ? 0 : conf->id, &((*pkt)[6 + 6]), pkt->len - 6 - 6, ++oseqno); // skip 2 macs	957	p->setup (this, conf->id, &((*pkt)[6 + 6]), pkt->len - 6 - 6, ++oseqno); // skip 2 macs
728	vpn->send_vpn_packet (p, si, tos);	958	send_vpn_packet (p, si, tos);
729		959
730	delete p;	960	delete p;
731		961
732	if (oseqno > MAX_SEQNO)	962	if (oseqno > MAX_SEQNO)
733	rekey ();	963	rekey ();
734	}	964	}
735		965
736	void	966	void
		967	connection::post_inject_queue ()
		968	{
		969	// force a connection every now and when when packets are sent (max 1/s)
		970	if (ev_now () - last_establish_attempt >= 0.95) // arbitrary
		971	establish_connection.stop ();
		972
		973	establish_connection ();
		974	}
		975
		976	void
737	connection::inject_data_packet (tap_packet *pkt, bool broadcast)	977	connection::inject_data_packet (tap_packet *pkt)
738	{	978	{
739	if (ictx && octx)	979	if (ictx && octx)
740	send_data_packet (pkt, broadcast);	980	send_data_packet (pkt);
741	else	981	else
742	{	982	{
743	if (!broadcast)//DDDD
744	queue.put (new tap_packet (*pkt));	983	data_queue.put (new tap_packet (*pkt));
		984	post_inject_queue ();
		985	}
		986	}
745		987
746	establish_connection ();	988	void connection::inject_vpn_packet (vpn_packet *pkt, int tos)
		989	{
		990	if (ictx && octx)
		991	send_vpn_packet (pkt, si, tos);
		992	else
		993	{
		994	vpn_queue.put ((vpn_packet *)new data_packet (*(data_packet *)pkt));
		995	post_inject_queue ();
747	}	996	}
748	}	997	}
749		998
750	void	999	void
751	connection::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)	1000	connection::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)
752	{	1001	{
753	last_activity = NOW;	1002	last_activity = ev_now ();
754		1003
755	slog (L_NOISE, "<<%d received packet type %d from %d to %d",	1004	slog (L_NOISE, "<<%d received packet type %d from %d to %d.",
756	conf->id, pkt->typ (), pkt->src (), pkt->dst ());	1005	conf->id, pkt->typ (), pkt->src (), pkt->dst ());
		1006
		1007	if (connectmode == conf_node::C_DISABLED)
		1008	return;
757		1009
758	switch (pkt->typ ())	1010	switch (pkt->typ ())
759	{	1011	{
760	case vpn_packet::PT_PING:	1012	case vpn_packet::PT_PING:
761	// we send pings instead of auth packets after some retries,	1013	// we send pings instead of auth packets after some retries,
…		…
765	{	1017	{
766	if (auth_rate_limiter.can (rsi))	1018	if (auth_rate_limiter.can (rsi))
767	send_auth_request (rsi, true);	1019	send_auth_request (rsi, true);
768	}	1020	}
769	else	1021	else
		1022	// we would love to change thre socket address here, but ping's aren't
		1023	// authenticated, so we best ignore it.
770	send_ping (rsi, 1); // pong	1024	send_ping (rsi, 1); // pong
771		1025
772	break;	1026	break;
773		1027
774	case vpn_packet::PT_PONG:	1028	case vpn_packet::PT_PONG:
…		…
780		1034
781	config_packet *p = (config_packet *) pkt;	1035	config_packet *p = (config_packet *) pkt;
782		1036
783	if (!p->chk_config ())	1037	if (!p->chk_config ())
784	{	1038	{
785	slog (L_WARN, _("%s(%s): protocol mismatch, disabling node"),	1039	slog (L_WARN, _("%s(%s): protocol mismatch, disabling node."),
786	conf->nodename, (const char *)rsi);	1040	conf->nodename, (const char *)rsi);
787	connectmode = conf_node::C_DISABLED;	1041	connectmode = conf_node::C_DISABLED;
788	}	1042	}
789	else if (connectmode == conf_node::C_ALWAYS)	1043	else if (connectmode == conf_node::C_ALWAYS)
790	establish_connection ();	1044	establish_connection ();
…		…
808	if (p->initiate)	1062	if (p->initiate)
809	send_auth_request (rsi, false);	1063	send_auth_request (rsi, false);
810		1064
811	rsachallenge k;	1065	rsachallenge k;
812		1066
813	if (0 > RSA_private_decrypt (sizeof (p->encr),	1067	if (!rsa_decrypt (::conf.rsa_key, p->encr, k))
814	(unsigned char *)&p->encr, (unsigned char *)&k,	1068	{
815	::conf.rsa_key, RSA_PKCS1_OAEP_PADDING))
816	slog (L_ERR, _("%s(%s): challenge illegal or corrupted"),	1069	slog (L_ERR, _("%s(%s): challenge illegal or corrupted (%s). mismatched key or config file?"),
817	conf->nodename, (const char *)rsi);	1070	conf->nodename, (const char *)rsi, ERR_error_string (ERR_get_error (), 0));
		1071	break;
		1072	}
818	else	1073	else
819	{	1074	{
820	retry_cnt = 0;
821	establish_connection.start (NOW + 8); //? ;)
822	keepalive.reset ();
823	rekey.reset ();
824
825	delete ictx;
826	ictx = 0;
827
828	delete octx;	1075	delete octx;
829		1076
830	octx = new crypto_ctx (k, 1);	1077	octx = new crypto_ctx (k, 1);
831	oseqno = ntohl (*(u32 *)&k[CHG_SEQNO]) & 0x7fffffff;	1078	oseqno = ntohl (*(u32 *)&k[CHG_SEQNO]) & 0x7fffffff;
832		1079
833	conf->protocols = p->protocols;	1080	conf->protocols = p->protocols;
		1081	features = p->features & config_packet::get_features ();
		1082
834	send_auth_response (rsi, p->id, k);	1083	send_auth_response (rsi, p->id, k);
		1084
		1085	connection_established ();
835		1086
836	break;	1087	break;
837	}	1088	}
838	}	1089	}
		1090	else
		1091	slog (L_WARN, _("%s(%s): protocol mismatch."),
		1092	conf->nodename, (const char *)rsi);
839		1093
840	send_reset (rsi);	1094	send_reset (rsi);
841	}	1095	}
842		1096
843	break;	1097	break;
…		…
856	PROTOCOL_MINOR, conf->nodename, p->prot_minor);	1110	PROTOCOL_MINOR, conf->nodename, p->prot_minor);
857		1111
858	rsachallenge chg;	1112	rsachallenge chg;
859		1113
860	if (!rsa_cache.find (p->id, chg))	1114	if (!rsa_cache.find (p->id, chg))
		1115	{
861	slog (L_ERR, _("%s(%s): unrequested auth response"),	1116	slog (L_ERR, _("%s(%s): unrequested auth response, ignoring."),
862	conf->nodename, (const char *)rsi);	1117	conf->nodename, (const char *)rsi);
		1118	break;
		1119	}
863	else	1120	else
864	{	1121	{
865	crypto_ctx *cctx = new crypto_ctx (chg, 0);	1122	crypto_ctx *cctx = new crypto_ctx (chg, 0);
866		1123
867	if (!p->hmac_chk (cctx))	1124	if (!p->hmac_chk (cctx))
		1125	{
868	slog (L_ERR, _("%s(%s): hmac authentication error on auth response, received invalid packet\n"	1126	slog (L_ERR, _("%s(%s): hmac authentication error on auth response, received invalid packet\n"
869	"could be an attack, or just corruption or an synchronization error"),	1127	"could be an attack, or just corruption or a synchronization error."),
870	conf->nodename, (const char *)rsi);	1128	conf->nodename, (const char *)rsi);
		1129	break;
		1130	}
871	else	1131	else
872	{	1132	{
873	rsaresponse h;	1133	rsaresponse h;
874		1134
875	rsa_hash (p->id, chg, h);	1135	rsa_hash (p->id, chg, h);
…		…
881	delete ictx; ictx = cctx;	1141	delete ictx; ictx = cctx;
882		1142
883	iseqno.reset (ntohl (*(u32 *)&chg[CHG_SEQNO]) & 0x7fffffff); // at least 2**31 sequence numbers are valid	1143	iseqno.reset (ntohl (*(u32 *)&chg[CHG_SEQNO]) & 0x7fffffff); // at least 2**31 sequence numbers are valid
884		1144
885	si = rsi;	1145	si = rsi;
		1146	protocol = rsi.prot;
886		1147
887	rekey.start (NOW + ::conf.rekey);	1148	slog (L_INFO, _("%s(%s): connection established, protocol version %d.%d."),
888	keepalive.start (NOW + ::conf.keepalive);	1149	conf->nodename, (const char *)rsi,
		1150	p->prot_major, p->prot_minor);
889		1151
890	// send queued packets	1152	connection_established ();
891	while (tap_packet *p = queue.get ())	1153
		1154	if (::conf.script_node_up)
892	{	1155	{
893	send_data_packet (p);	1156	run_script_cb *cb = new run_script_cb;
894	delete p;	1157	cb->set<connection, &connection::script_node_up> (this);
		1158	run_script_queued (cb, _("node-up command execution failed, continuing."));
895	}	1159	}
896
897	connectmode = conf->connectmode;
898
899	slog (L_INFO, _("%s(%s): %s connection established, protocol version %d.%d"),
900	conf->nodename, (const char *)rsi,
901	strprotocol (protocol),
902	p->prot_major, p->prot_minor);
903
904	if (::conf.script_node_up)
905	run_script (run_script_cb (this, &connection::script_node_up), false);
906		1160
907	break;	1161	break;
908	}	1162	}
909	else	1163	else
910	slog (L_ERR, _("%s(%s): sent and received challenge do not match"),	1164	slog (L_ERR, _("%s(%s): sent and received challenge do not match."),
911	conf->nodename, (const char *)rsi);	1165	conf->nodename, (const char *)rsi);
912	}	1166	}
913		1167
914	delete cctx;	1168	delete cctx;
915	}	1169	}
…		…
929		1183
930	if (ictx && octx)	1184	if (ictx && octx)
931	{	1185	{
932	vpndata_packet *p = (vpndata_packet *)pkt;	1186	vpndata_packet *p = (vpndata_packet *)pkt;
933		1187
934	if (rsi == si)	1188	if (!p->hmac_chk (ictx))
		1189	slog (L_ERR, _("%s(%s): hmac authentication error, received invalid packet\n"
		1190	"could be an attack, or just corruption or a synchronization error."),
		1191	conf->nodename, (const char *)rsi);
		1192	else
935	{	1193	{
936	if (!p->hmac_chk (ictx))
937	slog (L_ERR, _("%s(%s): hmac authentication error, received invalid packet\n"
938	"could be an attack, or just corruption or an synchronization error"),
939	conf->nodename, (const char *)rsi);
940	else	1194	u32 seqno;
		1195	tap_packet *d = p->unpack (this, seqno);
		1196	int seqclass = iseqno.seqno_classify (seqno);
		1197
		1198	if (seqclass == 0) // ok
941	{	1199	{
942	u32 seqno;	1200	vpn->tap->send (d);
943	tap_packet *d = p->unpack (this, seqno);
944		1201
945	if (iseqno.recv_ok (seqno))	1202	if (si != rsi)
946	{	1203	{
947	vpn->tap->send (d);	1204	// fast re-sync on source address changes, useful especially for tcp/ip
948		1205	//if (last_si_change < ev_now () + 5.)
949	if (p->dst () == 0) // re-broadcast
950	for (vpn::conns_vector::iterator i = vpn->conns.begin (); i != vpn->conns.end (); ++i)
951	{	1206	// {
952	connection *c = *i;	1207	si = rsi;
953		1208
954	if (c->conf != THISNODE && c->conf != conf)	1209	slog (L_INFO, _("%s(%s): socket address changed to %s."),
955	c->inject_data_packet (d);	1210	conf->nodename, (const char *)si, (const char *)rsi);
956	}	1211	// }
957
958	delete d;	1212	//else
959		1213	// slog (L_INFO, _("%s(%s): accepted packet from %s, not (yet) redirecting traffic."),
960	break;	1214	// conf->nodename, (const char *)si, (const char *)rsi);
961	}	1215	}
962	}	1216	}
		1217	else if (seqclass == 1) // silently ignore
		1218	slog (L_ERR, _("received duplicate packet (received %08lx, expected %08lx)\n"
		1219	"possible replay attack, or just packet duplication, ignoring."), seqno, iseqno.seq + 1);
		1220	else if (seqclass == 2) // reset
		1221	{
		1222	slog (L_ERR, _("received duplicate or out-of-sync packet (received %08lx, expected %08lx)\n"
		1223	"possible replay attack, or just massive packet loss, resetting connection."), seqno, iseqno.seq + 1);
		1224	send_reset (rsi);
		1225	}
		1226
		1227	delete d;
		1228	break;
963	}	1229	}
964	else
965	slog (L_ERR, _("received data packet from unknown source %s"), (const char *)rsi);
966	}	1230	}
967		1231
968	send_reset (rsi);	1232	send_reset (rsi);
969	break;	1233	break;
970		1234
971	case vpn_packet::PT_CONNECT_REQ:	1235	case vpn_packet::PT_CONNECT_REQ:
972	if (ictx && octx && rsi == si && pkt->hmac_chk (ictx))	1236	if (ictx && octx && rsi == si && pkt->hmac_chk (ictx))
973	{	1237	{
974	connect_req_packet *p = (connect_req_packet *) pkt;	1238	connect_req_packet *p = (connect_req_packet *) pkt;
975		1239
976	assert (p->id > 0 && p->id <= vpn->conns.size ()); // hmac-auth does not mean we accept anything	1240	if (p->id > 0 && p->id <= vpn->conns.size ())
977	conf->protocols = p->protocols;
978	connection *c = vpn->conns[p->id - 1];
979
980	slog (L_TRACE, "<<%d PT_CONNECT_REQ(%d) [%d]\n",
981	conf->id, p->id, c->ictx && c->octx);
982
983	if (c->ictx && c->octx)
984	{	1241	{
		1242	connection *c = vpn->conns[p->id - 1];
		1243	conf->protocols = p->protocols;
		1244
		1245	slog (L_TRACE, "<<%d PT_CONNECT_REQ(%d) [%d]",
		1246	conf->id, p->id, c->ictx && c->octx);
		1247
		1248	if (c->ictx && c->octx)
		1249	{
985	// send connect_info packets to both sides, in case one is	1250	// send connect_info packets to both sides, in case one is
986	// behind a nat firewall (or both ;)	1251	// behind a nat firewall (or both ;)
987	c->send_connect_info (conf->id, si, conf->protocols);	1252	c->send_connect_info (conf->id, si, conf->protocols);
988	send_connect_info (c->conf->id, c->si, c->conf->protocols);	1253	send_connect_info (c->conf->id, c->si, c->conf->protocols);
		1254	}
		1255	else
		1256	c->establish_connection ();
989	}	1257	}
		1258	else
		1259	slog (L_WARN,
		1260	_("received authenticated connection request from unknown node #%d, config file mismatch?"),
		1261	p->id);
990	}	1262	}
991		1263
992	break;	1264	break;
993		1265
994	case vpn_packet::PT_CONNECT_INFO:	1266	case vpn_packet::PT_CONNECT_INFO:
995	if (ictx && octx && rsi == si && pkt->hmac_chk (ictx))	1267	if (ictx && octx && rsi == si && pkt->hmac_chk (ictx))
996	{	1268	{
997	connect_info_packet *p = (connect_info_packet *) pkt;	1269	connect_info_packet *p = (connect_info_packet *)pkt;
998		1270
999	assert (p->id > 0 && p->id <= vpn->conns.size ()); // hmac-auth does not mean we accept anything	1271	if (p->id > 0 && p->id <= vpn->conns.size ())
1000	conf->protocols = p->protocols;	1272	{
1001	connection *c = vpn->conns[p->id - 1];	1273	connection *c = vpn->conns[p->id - 1];
1002		1274
		1275	c->conf->protocols = p->protocols;
		1276	protocol = best_protocol (c->conf->protocols & THISNODE->protocols & p->si.supported_protocols (c->conf));
		1277	p->si.upgrade_protocol (protocol, c->conf);
		1278
1003	slog (L_TRACE, "<<%d PT_CONNECT_INFO(%d,%s) (%d)",	1279	slog (L_TRACE, "<<%d PT_CONNECT_INFO(%d,%s) (%d)",
1004	conf->id, p->id, (const char *)p->si, !c->ictx && !c->octx);	1280	conf->id, p->id, (const char *)p->si, !c->ictx && !c->octx);
1005		1281
		1282	const sockinfo &dsi = forward_si (p->si);
		1283
		1284	if (dsi.valid ())
1006	c->send_auth_request (p->si, true);	1285	c->send_auth_request (dsi, true);
		1286	}
		1287	else
		1288	slog (L_WARN,
		1289	_("received authenticated connection request from unknown node #%d, config file mismatch?"),
		1290	p->id);
1007	}	1291	}
1008		1292
1009	break;	1293	break;
1010		1294
1011	default:	1295	default:
1012	send_reset (rsi);	1296	send_reset (rsi);
1013	break;	1297	break;
1014	}	1298	}
1015	}	1299	}
1016		1300
1017	void connection::keepalive_cb (time_watcher &w)	1301	inline void
		1302	connection::keepalive_cb (ev::timer &w, int revents)
1018	{	1303	{
1019	if (NOW >= last_activity + ::conf.keepalive + 30)	1304	if (ev_now () >= last_activity + ::conf.keepalive + 30)
1020	{	1305	{
1021	reset_connection ();	1306	reset_connection ();
1022	establish_connection ();	1307	establish_connection ();
1023	}	1308	}
1024	else if (NOW < last_activity + ::conf.keepalive)	1309	else if (ev_now () < last_activity + ::conf.keepalive)
1025	w.at = last_activity + ::conf.keepalive;	1310	w.start (last_activity + ::conf.keepalive - ev::now ());
1026	else if (conf->connectmode != conf_node::C_ONDEMAND	1311	else if (conf->connectmode != conf_node::C_ONDEMAND
1027	|| THISNODE->connectmode != conf_node::C_ONDEMAND)	1312	|| THISNODE->connectmode != conf_node::C_ONDEMAND)
1028	{	1313	{
1029	send_ping (si);	1314	send_ping (si);
1030	w.at = NOW + 5;	1315	w.start (5);
1031	}	1316	}
		1317	else if (ev_now () < last_activity + ::conf.keepalive + 10)
		1318	// hold ondemand connections implicitly a few seconds longer
		1319	// should delete octx, though, or something like that ;)
		1320	w.start (last_activity + ::conf.keepalive + 10 - ev::now ());
1032	else	1321	else
1033	reset_connection ();	1322	reset_connection ();
1034	}	1323	}
1035		1324
1036	void connection::connect_request (int id)	1325	void connection::send_connect_request (int id)
1037	{	1326	{
1038	connect_req_packet *p = new connect_req_packet (conf->id, id, conf->protocols);	1327	connect_req_packet *p = new connect_req_packet (conf->id, id, conf->protocols);
1039		1328
1040	slog (L_TRACE, ">>%d PT_CONNECT_REQ(%d)", conf->id, id);	1329	slog (L_TRACE, ">>%d PT_CONNECT_REQ(%d)", conf->id, id);
1041	p->hmac_set (octx);	1330	p->hmac_set (octx);
1042	vpn->send_vpn_packet (p, si);	1331	send_vpn_packet (p, si);
1043		1332
1044	delete p;	1333	delete p;
1045	}	1334	}
1046		1335
		1336	void connection::script_init_env (const char *ext)
		1337	{
		1338	char *env;
		1339	asprintf (&env, "IFUPDATA%s=%s", ext, conf->if_up_data); putenv (env);
		1340	asprintf (&env, "NODENAME%s=%s", ext, conf->nodename); putenv (env);
		1341	asprintf (&env, "MAC%s=%02x:%02x:%02x:%02x:%02x:%02x", ext,
		1342	0xfe, 0xfd, 0x80, 0x00, conf->id >> 8,
		1343	conf->id & 0xff); putenv (env);
		1344	}
		1345
1047	void connection::script_node ()	1346	void connection::script_init_connect_env ()
1048	{	1347	{
1049	vpn->script_if_up ();	1348	vpn->script_init_env ();
1050		1349
1051	char *env;	1350	char *env;
1052	asprintf (&env, "DESTID=%d", conf->id); putenv (env);	1351	asprintf (&env, "DESTID=%d", conf->id); putenv (env);
1053	asprintf (&env, "DESTNODE=%s", conf->nodename); putenv (env);	1352	asprintf (&env, "DESTNODE=%s", conf->nodename); putenv (env);
1054	asprintf (&env, "DESTIP=%s", si.ntoa ()); putenv (env);	1353	asprintf (&env, "DESTIP=%s", si.ntoa ()); putenv (env);
1055	asprintf (&env, "DESTPORT=%d", ntohs (si.port)); putenv (env);	1354	asprintf (&env, "DESTPORT=%d", ntohs (si.port)); putenv (env);
1056	}	1355	}
1057		1356
		1357	inline const char *
1058	const char *connection::script_node_up ()	1358	connection::script_node_up ()
1059	{	1359	{
1060	script_node ();	1360	script_init_connect_env ();
1061		1361
1062	putenv ("STATE=up");	1362	putenv ((char *)"STATE=up");
1063		1363
		1364	char *filename;
		1365	asprintf (&filename,
		1366	"%s/%s",
		1367	confbase,
1064	return ::conf.script_node_up ? ::conf.script_node_up : "node-up";	1368	::conf.script_node_up ? ::conf.script_node_up : "node-up");
1065	}
1066		1369
		1370	return filename;
		1371	}
		1372
		1373	inline const char *
1067	const char *connection::script_node_down ()	1374	connection::script_node_down ()
1068	{	1375	{
1069	script_node ();	1376	script_init_connect_env ();
1070		1377
1071	putenv ("STATE=down");	1378	putenv ((char *)"STATE=down");
1072		1379
1073	return ::conf.script_node_up ? ::conf.script_node_down : "node-down";	1380	char *filename;
1074	}	1381	asprintf (&filename,
		1382	"%s/%s",
		1383	confbase,
		1384	::conf.script_node_down ? ::conf.script_node_down : "node-down");
1075		1385
		1386	return filename;
		1387	}
		1388
1076	connection::connection(struct vpn *vpn_)	1389	connection::connection (struct vpn *vpn, conf_node *conf)
1077	: vpn(vpn_)	1390	: vpn(vpn), conf(conf),
1078	, rekey (this, &connection::rekey_cb)	1391	#if ENABLE_DNS
1079	, keepalive (this, &connection::keepalive_cb)	1392	dns (0),
		1393	#endif
		1394	data_queue(conf->max_ttl, conf->max_queue + 1),
		1395	vpn_queue(conf->max_ttl, conf->max_queue + 1)
		1396	{
		1397	rekey .set<connection, &connection::rekey_cb > (this);
		1398	keepalive .set<connection, &connection::keepalive_cb > (this);
1080	, establish_connection (this, &connection::establish_connection_cb)	1399	establish_connection.set<connection, &connection::establish_connection_cb> (this);
1081	{	1400
		1401	last_establish_attempt = 0.;
1082	octx = ictx = 0;	1402	octx = ictx = 0;
1083	retry_cnt = 0;
1084		1403
1085	connectmode = conf_node::C_ALWAYS; // initial setting	1404	if (!conf->protocols) // make sure some protocol is enabled
		1405	conf->protocols = PROT_UDPv4;
		1406
		1407	connectmode = conf->connectmode;
		1408
		1409	// queue a dummy packet to force an initial connection attempt
		1410	if (connectmode != conf_node::C_ALWAYS && connectmode != conf_node::C_DISABLED)
		1411	vpn_queue.put (new net_packet);
		1412
1086	reset_connection ();	1413	reset_connection ();
1087	}	1414	}
1088		1415
1089	connection::~connection ()	1416	connection::~connection ()
1090	{	1417	{

Diff Legend

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