ViewVC Help

View File | Revision Log | Show Annotations | Download File

/cvs/gvpe/src/connection.C

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

Diff Legend

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