ViewVC Help

View File | Revision Log | Show Annotations | Download File

/cvs/gvpe/src/connection.C

Comparing gvpe/src/connection.C (file contents):
Revision 1.1 by pcg, Wed Apr 2 03:06:22 2003 UTC vs.
Revision 1.112 by root, Fri Sep 12 10:40:43 2014 UTC

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

Diff Legend

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