[ViewVC] Diff of: cvs/gvpe/src/connection.C

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

Diff Legend

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

Comparing gvpe/src/connection.C (file contents): Revision 1.14 by pcg, Fri Aug 8 09:29:22 2003 UTC vs. Revision 1.115 by root, Thu Jun 30 16:31:00 2016 UTC

Diff Legend

Comparing gvpe/src/connection.C (file contents):
Revision 1.14 by pcg, Fri Aug 8 09:29:22 2003 UTC vs.
Revision 1.115 by root, Thu Jun 30 16:31:00 2016 UTC