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.115 by root, Thu Jun 30 16:31:00 2016 UTC

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

Diff Legend

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