ViewVC Help

View File | Revision Log | Show Annotations | Download File

/cvs/gvpe/src/connection.C

Comparing gvpe/src/connection.C (file contents):
Revision 1.36 by pcg, Sun May 30 17:36:00 2004 UTC vs.
Revision 1.115 by root, Thu Jun 30 16:31:00 2016 UTC

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

Diff Legend

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