ViewVC Help

View File | Revision Log | Show Annotations | Download File

/cvs/gvpe/src/connection.C

Comparing gvpe/src/connection.C (file contents):
Revision 1.50 by pcg, Fri Mar 18 01:53:05 2005 UTC vs.
Revision 1.113 by root, Thu Jan 29 00:21:39 2015 UTC

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

Diff Legend

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