ViewVC Help

View File | Revision Log | Show Annotations | Download File

/cvs/gvpe/src/connection.C

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

Diff Legend

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