ViewVC Help

View File | Revision Log | Show Annotations | Download File

/cvs/gvpe/src/vpn_dns.C

Comparing gvpe/src/vpn_dns.C (file contents):
Revision 1.6 by pcg, Thu Mar 3 08:38:32 2005 UTC vs.
Revision 1.34 by pcg, Tue Mar 15 19:26:11 2005 UTC

1	/*	1	/*
2	vpn_dns.C -- handle the dns tunnel part of the protocol.	2	vpn_dns.C -- handle the dns tunnel part of the protocol.
3	Copyright (C) 2003-2004 Marc Lehmann <pcg@goof.com>	3	Copyright (C) 2003-2005 Marc Lehmann <gvpe@schmorp.de>
4		4
		5	This file is part of GVPE.
		6
5	This program is free software; you can redistribute it and/or modify	7	GVPE is free software; you can redistribute it and/or modify
6	it under the terms of the GNU General Public License as published by	8	it under the terms of the GNU General Public License as published by
7	the Free Software Foundation; either version 2 of the License, or	9	the Free Software Foundation; either version 2 of the License, or
8	(at your option) any later version.	10	(at your option) any later version.
9		11
10	This program is distributed in the hope that it will be useful,	12	This program is distributed in the hope that it will be useful,
11	but WITHOUT ANY WARRANTY; without even the implied warranty of	13	but WITHOUT ANY WARRANTY; without even the implied warranty of
12	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the	14	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13	GNU General Public License for more details.	15	GNU General Public License for more details.
14		16
15	You should have received a copy of the GNU General Public License	17	You should have received a copy of the GNU General Public License
16	along with this program; if not, write to the Free Software	18	along with gvpe; if not, write to the Free Software
17	Foundation, Inc. 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA	19	Foundation, Inc. 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
18	*/	20	*/
19		21
20	#include "config.h"	22	#include "config.h"
21		23
…		…
23		25
24	// dns processing is EXTREMELY ugly. For obvious(?) reasons.	26	// dns processing is EXTREMELY ugly. For obvious(?) reasons.
25	// it's a hack, use only in emergency situations please.	27	// it's a hack, use only in emergency situations please.
26		28
27	#include <cstring>	29	#include <cstring>
		30	#include <cassert>
28		31
29	#include <sys/types.h>	32	#include <sys/types.h>
30	#include <sys/socket.h>	33	#include <sys/socket.h>
31	#include <sys/wait.h>	34	#include <sys/wait.h>
32	#include <sys/uio.h>	35	#include <sys/uio.h>
…		…
35	#include <unistd.h>	38	#include <unistd.h>
36	#include <fcntl.h>	39	#include <fcntl.h>
37		40
38	#include <map>	41	#include <map>
39		42
		43	#include <gmp.h>
		44
40	#include "netcompat.h"	45	#include "netcompat.h"
41		46
42	#include "vpn.h"	47	#include "vpn.h"
43		48
44	#define MIN_RETRY 1.	49	#define MAX_POLL_INTERVAL 5. // how often to poll minimally when the server has no data
45	#define MAX_RETRY 60.	50	#define ACTIVITY_INTERVAL 5.
46		51
		52	#define TIMEOUT_FACTOR 2.
		53
		54	#define INITIAL_TIMEOUT 0.1 // retry timeouts
		55	#define INITIAL_SYN_TIMEOUT 10. // retry timeout for initial syn
		56
		57	#define MIN_SEND_INTERVAL 0.001 // wait at least this time between sending requests
		58	#define MAX_SEND_INTERVAL 2. // optimistic?
		59
		60	#define LATENCY_FACTOR 0.5 // RTT * LATENCY_FACTOR == sending rate
47	#define MAX_OUTSTANDING 40 // max. outstanding requests	61	#define MAX_OUTSTANDING 100 // max. outstanding requests
48	#define MAX_WINDOW 100 // max. for MAX_OUTSTANDING	62	#define MAX_WINDOW 1000 // max. for MAX_OUTSTANDING, and backlog
49	#define MAX_RATE 1000 // requests/s
50	#define MAX_BACKLOG (10*1024) // size of protocol backlog, must be > MAXSIZE	63	#define MAX_BACKLOG (32*1024) // size of gvpe protocol backlog (bytes), must be > MAXSIZE
51		64
52	#define MAX_DOMAIN_SIZE 220 // 255 is legal limit, but bind doesn't compress well	65	#define MAX_DOMAIN_SIZE 240 // 255 is legal limit, but bind doesn't compress well
53	// 240 leaves about 4 bytes of server reply data	66	// 240 leaves about 4 bytes of server reply data
54	// every two request byte sless give room for one reply byte	67	// every request byte less give room for two reply bytes
55		68
56	// seqno has 12 bits, but the lower bit is always left as zero
57	// as bind caches ttl=0 records and we have to generate
58	// sequence numbers that always differ case-insensitively
59	#define SEQNO_MASK 0x07ff	69	#define SEQNO_MASK 0x3fff
60		70	#define SEQNO_EQ(a,b) ( 0 == ( ((a) ^ (b)) & SEQNO_MASK) )
61	/*
62
63	protocol, in shorthand :)
64
65	client -> server <req> ANY?
66	server -> client <req> TXT <rep>
67
68	<req> is dns64-encoded <client-id:12><recv-seqno:10>[<send-seqno:10><data>]
69	<rep> is dns64-encoded <0:12><recv-seqno:10>[<send-seqno:10><data>]
70
71	if <client-id> is zero, the connection will be configured:
72
73	<0:12><0:4>client-id:12><default-ttl:8><max-size:16><flags:16>
74
75	*/
76		71
77	#define MAX_LBL_SIZE 63	72	#define MAX_LBL_SIZE 63
78	#define MAX_PKT_SIZE 512	73	#define MAX_PKT_SIZE 512
79		74
		75	#define RR_TYPE_A 1
		76	#define RR_TYPE_NULL 10
80	#define RR_TYPE_TXT 16	77	#define RR_TYPE_TXT 16
81	#define RR_TYPE_ANY 255	78	#define RR_TYPE_ANY 255
		79
82	#define RR_CLASS_IN 1	80	#define RR_CLASS_IN 1
83		81
84	// the "_" is not valid but widely accepted (all octets should be supported, but let's be conservative)	82	#define CMD_IP_1 207
85	struct dns64	83	#define CMD_IP_2 46
86	{	84	#define CMD_IP_3 236
87	static const char encode_chars[64 + 1];	85	#define CMD_IP_RST 29
88	static s8 decode_chars[256];	86	#define CMD_IP_SYN 113
		87	#define CMD_IP_REJ 32
89		88
90	static int encode_len (int bytes) { return (bytes * 8 + 5) / 6; }	89	// works for cmaps up to 255 (not 256!)
91	static int decode_len (int bytes) { return (bytes * 6) / 8; }	90	struct charmap
		91	{
		92	enum { INVALID = (u8)255 };
		93
		94	char encode [256]; // index => char
		95	u8 decode [256]; // char => index
		96	unsigned int size;
		97
		98	charmap (const char *cmap);
		99	};
		100
		101	charmap::charmap (const char *cmap)
		102	{
		103	char *enc = encode;
		104	u8 *dec = decode;
		105
		106	memset (enc, (char) 0, 256);
		107	memset (dec, (char)INVALID, 256);
		108
		109	for (size = 0; cmap [size]; size++)
		110	{
		111	enc [size] = cmap [size];
		112	dec [(u8)enc [size]] = size;
		113	}
		114
		115	assert (size < 256);
		116	}
		117
		118	#define MAX_DEC_LEN 500
		119	#define MAX_ENC_LEN (MAX_DEC_LEN * 2)
		120	#define MAX_LIMBS ((MAX_DEC_LEN * 8 + GMP_NUMB_BITS - 1) / GMP_NUMB_BITS)
		121
		122	// ugly. minimum base is 16(!)
		123	struct basecoder
		124	{
		125	charmap cmap;
		126	unsigned int enc_len [MAX_DEC_LEN];
		127	unsigned int dec_len [MAX_ENC_LEN];
		128
		129	unsigned int encode_len (unsigned int len);
		130	unsigned int decode_len (unsigned int len);
		131
92	static int encode (char *dst, u8 *src, int len);	132	unsigned int encode (char *dst, u8 *src, unsigned int len);
93	static int decode (u8 *dst, char *src, int len);	133	unsigned int decode (u8 *dst, char *src, unsigned int len);
94		134
95	dns64 ();	135	basecoder (const char *cmap);
96	} dns64;	136	};
97		137
98	// the following sequence has been crafted to	138	basecoder::basecoder (const char *cmap)
99	// a) look somewhat random	139	: cmap (cmap)
100	// b) the even (and odd) indices never share the same character as upper/lowercase
101	const char dns64::encode_chars[64 + 1] = "_-dDpPhHzZrR06QqMmjJkKBb34TtSsvVlL81xXaAeEFf92WwGgYyoO57UucCNniI";
102	s8 dns64::decode_chars[256];
103
104	dns64::dns64 ()
105	{	140	{
106	for (int i = 0; i < 64; i++)	141	for (unsigned int len = 0; len < MAX_DEC_LEN; ++len)
107	decode_chars [encode_chars [i]] = i + 1;	142	{
108	}	143	u8 src [MAX_DEC_LEN];
		144	u8 dst [MAX_ENC_LEN];
109		145
110	int dns64::encode (char *dst, u8 *src, int len)	146	memset (src, 255, len);
		147
		148	mp_limb_t m [MAX_LIMBS];
		149	mp_size_t n;
		150
		151	n = mpn_set_str (m, src, len, 256);
		152	n = mpn_get_str (dst, this->cmap.size, m, n);
		153
		154	for (int i = 0; !dst [i]; ++i)
		155	n--;
		156
		157	enc_len [len] = n;
		158	dec_len [n] = len;
		159	}
		160	}
		161
		162	unsigned int basecoder::encode_len (unsigned int len)
111	{	163	{
112	// slow, but easy to debug	164	return enc_len [len];
113	char *beg = dst;	165	}
114	unsigned int accum, bits = 0;	166
		167	unsigned int basecoder::decode_len (unsigned int len)
		168	{
		169	while (len && !dec_len [len])
		170	--len;
		171
		172	return dec_len [len];
		173	}
		174
		175	unsigned int basecoder::encode (char *dst, u8 *src, unsigned int len)
		176	{
		177	if (!len || len > MAX_DEC_LEN)
		178	return 0;
		179
		180	int elen = encode_len (len);
		181
		182	mp_limb_t m [MAX_LIMBS];
		183	mp_size_t n;
		184
		185	u8 dst_ [MAX_ENC_LEN];
		186
		187	n = mpn_set_str (m, src, len, 256);
		188	n = mpn_get_str (dst_, cmap.size, m, n);
		189
		190	int plen = elen; // for padding
		191
		192	while (n < plen)
		193	{
		194	*dst++ = cmap.encode [0];
		195	plen--;
		196	}
		197
		198	for (unsigned int i = n - plen; i < n; ++i)
		199	*dst++ = cmap.encode [dst_ [i]];
		200
		201	return elen;
		202	}
		203
		204	unsigned int basecoder::decode (u8 *dst, char *src, unsigned int len)
		205	{
		206	if (!len || len > MAX_ENC_LEN)
		207	return 0;
		208
		209	u8 src_ [MAX_ENC_LEN];
		210	unsigned int elen = 0;
115		211
116	while (len--)	212	while (len--)
117	{	213	{
118	accum <<= 8;	214	u8 val = cmap.decode [(u8)*src++];
119	accum |= *src++;
120	bits += 8;
121		215
122	while (bits >= 6)	216	if (val != charmap::INVALID)
123	{	217	src_ [elen++] = val;
124	*dst++ = encode_chars [(accum >> (bits - 6)) & 63];	218	}
125	bits -= 6;	219
126	}	220	int dlen = decode_len (elen);
		221
		222	mp_limb_t m [MAX_LIMBS];
		223	mp_size_t n;
		224
		225	u8 dst_ [MAX_DEC_LEN];
		226
		227	n = mpn_set_str (m, src_, elen, cmap.size);
		228	n = mpn_get_str (dst_, 256, m, n);
		229
		230	if (n < dlen)
127	}	231	{
		232	memset (dst, 0, dlen - n);
		233	memcpy (dst + dlen - n, dst_, n);
		234	}
		235	else
		236	memcpy (dst, dst_ + n - dlen, dlen);
128		237
129	if (bits)	238	return dlen;
130	*dst++ = encode_chars [(accum << (6 - bits)) & 63];
131
132	return dst - beg;
133	}	239	}
134		240
135	int dns64::decode (u8 *dst, char *src, int len)	241	#if 0
136	{	242	struct test { test (); } test;
137	// slow, but easy to debug
138	u8 *beg = dst;
139	unsigned int accum, bits = 0;
140		243
141	while (len--)	244	test::test ()
		245	{
		246	basecoder cdc ("0123456789abcdefghijklmnopqrstuvwxyz");
		247
		248	u8 in[] = "0123456789abcdefghijklmnopqrstuvwxyz";
		249	static char enc[200];
		250	static u8 dec[200];
		251
		252	for (int i = 1; i < 20; i++)
142	{	253	{
143	s8 chr = decode_chars [(u8)*src++];	254	int elen = cdc.encode (enc, in, i);
		255	int dlen = cdc.decode (dec, enc, elen);
144		256
145	if (!chr)	257	printf ("%d>%d>%d (%s>%s)\n", i, elen, dlen, enc, dec);
146	continue;
147
148	accum <<= 6;
149	accum |= chr - 1;
150	bits += 6;
151
152	while (bits >= 8)
153	{
154	*dst++ = accum >> (bits - 8);
155	bits -= 8;
156	}
157	}	258	}
		259	abort ();
		260	}
		261	#endif
158		262
159	return dst - beg;	263	//static basecoder cdc64 ("_dDpPhHzZrR06QqMmjJkKBb34TtSsvVlL81xXaAeEFf92WwGgYyoO57UucCNniI-");
		264	//static basecoder cdc63 ("_dDpPhHzZrR06QqMmjJkKBb34TtSsvVlL81xXaAeEFf92WwGgYyoO57UucCNniI");
		265	static basecoder cdc62 ("dDpPhHzZrR06QqMmjJkKBb34TtSsvVlL81xXaAeEFf92WwGgYyoO57UucCNniI");
		266	//static basecoder cdc36 ("dphzr06qmjkb34tsvl81xaef92wgyo57ucni"); // unused as of yet
		267	static basecoder cdc26 ("dPhZrQmJkBtSvLxAeFwGyO");
		268
		269	/////////////////////////////////////////////////////////////////////////////
		270
		271	#define HDRSIZE 6
		272
		273	inline void encode_header (char *data, int clientid, int seqno, int retry = 0)
		274	{
		275	seqno &= SEQNO_MASK;
		276
		277	u8 hdr[3] = {
		278	clientid,
		279	(seqno >> 8) | (retry << 6),
		280	seqno,
		281	};
		282
		283	assert (clientid < 256);
		284
		285	cdc26.encode (data, hdr, 3);
		286	}
		287
		288	inline void decode_header (char *data, int &clientid, int &seqno)
		289	{
		290	u8 hdr[3];
		291
		292	cdc26.decode (hdr, data, HDRSIZE);
		293
		294	clientid = hdr[0];
		295	seqno = ((hdr[1] << 8) | hdr[2]) & SEQNO_MASK;
160	}	296	}
161		297
162	/////////////////////////////////////////////////////////////////////////////	298	/////////////////////////////////////////////////////////////////////////////
163		299
164	struct byte_stream	300	struct byte_stream
…		…
193	}	329	}
194		330
195	void byte_stream::remove (int count)	331	void byte_stream::remove (int count)
196	{	332	{
197	if (count > fill)	333	if (count > fill)
198	abort ();	334	assert (count <= fill);
199		335
200	memmove (data, data + count, fill -= count);	336	memmove (data, data + count, fill -= count);
201	}	337	}
202		338
203	bool byte_stream::put (u8 *data, unsigned int datalen)	339	bool byte_stream::put (u8 *data, unsigned int datalen)
…		…
216	return false;	352	return false;
217		353
218	data [fill++] = pkt->len >> 8;	354	data [fill++] = pkt->len >> 8;
219	data [fill++] = pkt->len;	355	data [fill++] = pkt->len;
220		356
221	memcpy (data + fill, &((*pkt)[0]), pkt->len); fill += pkt->len;	357	memcpy (data + fill, pkt->at (0), pkt->len); fill += pkt->len;
222		358
223	return true;	359	return true;
224	}	360	}
225		361
226	vpn_packet *byte_stream::get ()	362	vpn_packet *byte_stream::get ()
227	{	363	{
		364	unsigned int len;
		365
		366	for (;;)
		367	{
228	int len = (data [0] << 8) | data [1];	368	len = (data [0] << 8) | data [1];
229		369
230	if (len > MAXSIZE && fill >= 2)	370	if (len <= MAXSIZE || fill < 2)
231	abort (); // TODO handle this gracefully, connection reset	371	break;
232		372
		373	// TODO: handle this better than skipping, e.g. by reset
		374	slog (L_DEBUG, _("DNS: corrupted packet stream skipping a byte..."));
		375	remove (1);
		376	}
		377
233	if (fill < len + 2)	378	if (fill < len + 2)
234	return 0;	379	return 0;
235		380
236	vpn_packet *pkt = new vpn_packet;	381	vpn_packet *pkt = new vpn_packet;
237		382
238	pkt->len = len;	383	pkt->len = len;
239	memcpy (&((*pkt)[0]), data + 2, len);	384	memcpy (pkt->at (0), data + 2, len);
240	remove (len + 2);	385	remove (len + 2);
241		386
242	return pkt;	387	return pkt;
243	}	388	}
244		389
245	/////////////////////////////////////////////////////////////////////////////	390	/////////////////////////////////////////////////////////////////////////////
246		391
247	#define FLAG_QUERY ( 0 << 15)	392	#define FLAG_QUERY ( 0 << 15)
248	#define FLAG_RESPONSE ( 1 << 15)	393	#define FLAG_RESPONSE ( 1 << 15)
249	#define FLAG_OP_MASK (15 << 14)	394	#define FLAG_OP_MASK (15 << 11)
250	#define FLAG_OP_QUERY ( 0 << 11)	395	#define FLAG_OP_QUERY ( 0 << 11)
251	#define FLAG_AA ( 1 << 10)	396	#define FLAG_AA ( 1 << 10)
252	#define FLAG_TC ( 1 << 9)	397	#define FLAG_TC ( 1 << 9)
253	#define FLAG_RD ( 1 << 8)	398	#define FLAG_RD ( 1 << 8)
254	#define FLAG_RA ( 1 << 7)	399	#define FLAG_RA ( 1 << 7)
…		…
261	#define FLAG_RCODE_REFUSED ( 5 << 0)	406	#define FLAG_RCODE_REFUSED ( 5 << 0)
262		407
263	#define DEFAULT_CLIENT_FLAGS (FLAG_QUERY | FLAG_OP_QUERY | FLAG_RD)	408	#define DEFAULT_CLIENT_FLAGS (FLAG_QUERY | FLAG_OP_QUERY | FLAG_RD)
264	#define DEFAULT_SERVER_FLAGS (FLAG_RESPONSE | FLAG_OP_QUERY | FLAG_AA | FLAG_RD | FLAG_RA)	409	#define DEFAULT_SERVER_FLAGS (FLAG_RESPONSE | FLAG_OP_QUERY | FLAG_AA | FLAG_RD | FLAG_RA)
265		410
		411	struct dns_cfg
		412	{
		413	static int next_uid;
		414
		415	u8 id1, id2, id3, id4;
		416
		417	u8 version;
		418	u8 flags;
		419	u8 rrtype;
		420	u8 def_ttl;
		421
		422	u16 client;
		423	u16 uid; // to make request unique
		424
		425	u16 max_size;
		426	u8 seq_cdc;
		427	u8 req_cdc;
		428
		429	u8 rep_cdc;
		430	u8 delay; // time in 0.01s units that the server may delay replying packets
		431	u8 r3, r4;
		432
		433	u8 r5, r6, r7, r8;
		434
		435	void reset (int clientid);
		436	bool valid ();
		437	};
		438
		439	int dns_cfg::next_uid;
		440
		441	void dns_cfg::reset (int clientid)
		442	{
		443	id1 = 'G';
		444	id2 = 'V';
		445	id3 = 'P';
		446	id4 = 'E';
		447
		448	version = 1;
		449
		450	rrtype = RR_TYPE_TXT;
		451	flags = 0;
		452	def_ttl = 0;
		453	seq_cdc = 26;
		454	req_cdc = 62;
		455	rep_cdc = 0;
		456	max_size = htons (MAX_PKT_SIZE);
		457	client = htons (clientid);
		458	uid = next_uid++;
		459	delay = 0;
		460
		461	r3 = r4 = 0;
		462	r4 = r5 = r6 = r7 = 0;
		463	}
		464
		465	bool dns_cfg::valid ()
		466	{
		467	return id1 == 'G'
		468	&& id2 == 'V'
		469	&& id3 == 'P'
		470	&& id4 == 'E'
		471	&& seq_cdc == 26
		472	&& req_cdc == 62
		473	&& rep_cdc == 0
		474	&& version == 1;
		475	}
		476
266	struct dns_packet : net_packet	477	struct dns_packet : net_packet
267	{	478	{
268	u16 id;	479	u16 id;
269	u16 flags; // QR:1 Opcode:4 AA:1 TC:1 RD:1 RA:1 Z:3 RCODE:4	480	u16 flags; // QR:1 Opcode:4 AA:1 TC:1 RD:1 RA:1 Z:3 RCODE:4
270	u16 qdcount, ancount, nscount, arcount;	481	u16 qdcount, ancount, nscount, arcount;
271		482
272	u8 data[MAXSIZE - 6 * 2];	483	u8 data [MAXSIZE - 6 * 2];
273		484
274	int decode_label (char *data, int size, int &offs);	485	int decode_label (char *data, int size, int &offs);
275	};	486	};
276		487
277	int dns_packet::decode_label (char *data, int size, int &offs)	488	int dns_packet::decode_label (char *data, int size, int &offs)
…		…
308	return data - orig;	519	return data - orig;
309	}	520	}
310		521
311	/////////////////////////////////////////////////////////////////////////////	522	/////////////////////////////////////////////////////////////////////////////
312		523
313	struct dns_req
314	{
315	dns_packet *pkt;
316	tstamp next;
317	int retry;
318	connection *conn;
319	int seqno;
320
321	dns_req (connection *c);
322	void gen_stream_req (int seqno, byte_stream *stream);
323	};
324
325	static u16 dns_id = 12098; // TODO: should be per-vpn	524	static u16 dns_id = 0; // TODO: should be per-vpn
326		525
327	static u16 next_id ()	526	static u16 next_id ()
328	{	527	{
		528	if (!dns_id)
		529	dns_id = time (0);
		530
329	// the simplest lsfr with periodicity 65535 i could find	531	// the simplest lsfr with periodicity 65535 i could find
330	dns_id = (dns_id << 1)	532	dns_id = (dns_id << 1)
331	| (((dns_id >> 1)	533	| (((dns_id >> 1)
332	^ (dns_id >> 2)	534	^ (dns_id >> 2)
333	^ (dns_id >> 4)	535	^ (dns_id >> 4)
334	^ (dns_id >> 15)) & 1);	536	^ (dns_id >> 15)) & 1);
335		537
336	return dns_id;	538	return dns_id;
337	}	539	}
338		540
339	dns_req::dns_req (connection *c)	541	struct dns_rcv;
340	: conn (c)	542	struct dns_snd;
		543
		544	struct dns_connection
341	{	545	{
342	next = 0;	546	connection *c;
		547	struct vpn *vpn;
		548
		549	dns_cfg cfg;
		550
		551	bool established;
		552
		553	tstamp last_received;
		554	tstamp last_sent;
		555	double min_latency;
		556	double poll_interval, send_interval;
		557
		558	vector<dns_rcv *> rcvpq;
		559
		560	byte_stream rcvdq; int rcvseq; int repseq;
		561	byte_stream snddq; int sndseq;
		562
		563	void time_cb (time_watcher &w); time_watcher tw;
		564	void receive_rep (dns_rcv *r);
		565
		566	dns_connection (connection *c);
		567	~dns_connection ();
		568	};
		569
		570	struct dns_snd
		571	{
		572	dns_packet *pkt;
		573	tstamp timeout, sent;
		574	int retry;
		575	struct dns_connection *dns;
		576	int seqno;
		577	bool stdhdr;
		578
		579	void gen_stream_req (int seqno, byte_stream &stream);
		580	void gen_syn_req ();
		581
		582	dns_snd (dns_connection *dns);
		583	~dns_snd ();
		584	};
		585
		586	dns_snd::dns_snd (dns_connection *dns)
		587	: dns (dns)
		588	{
		589	timeout = 0;
343	retry = 0;	590	retry = 0;
		591	seqno = 0;
		592	sent = NOW;
		593	stdhdr = false;
344		594
345	pkt = new dns_packet;	595	pkt = new dns_packet;
346		596
347	pkt->id = next_id ();	597	pkt->id = next_id ();
348	}	598	}
349		599
		600	dns_snd::~dns_snd ()
		601	{
		602	delete pkt;
		603	}
		604
		605	static void append_domain (dns_packet &pkt, int &offs, const char *domain)
		606	{
		607	// add tunnel domain
		608	for (;;)
		609	{
		610	const char *end = strchr (domain, '.');
		611
		612	if (!end)
		613	end = domain + strlen (domain);
		614
		615	int len = end - domain;
		616
		617	pkt [offs++] = len;
		618	memcpy (pkt.at (offs), domain, len);
		619	offs += len;
		620
		621	if (!*end)
		622	break;
		623
		624	domain = end + 1;
		625	}
		626	}
		627
350	void dns_req::gen_stream_req (int seqno, byte_stream *stream)	628	void dns_snd::gen_stream_req (int seqno, byte_stream &stream)
351	{	629	{
		630	stdhdr = true;
352	this->seqno = seqno;	631	this->seqno = seqno;
		632
		633	timeout = NOW + INITIAL_TIMEOUT;
353		634
354	pkt->flags = htons (DEFAULT_CLIENT_FLAGS);	635	pkt->flags = htons (DEFAULT_CLIENT_FLAGS);
355	pkt->qdcount = htons (1);	636	pkt->qdcount = htons (1);
356		637
357	int offs = 6*2;	638	int offs = 6*2;
358	int dlen = MAX_DOMAIN_SIZE - strlen (THISNODE->domain) - 2;	639	int dlen = MAX_DOMAIN_SIZE - (strlen (dns->c->conf->domain) + 2);
359	// MAX_DOMAIN_SIZE is technically 255, but bind doesn't compress responses well,	640	// MAX_DOMAIN_SIZE is technically 255, but bind doesn't compress responses well,
360	// so we need to have space for 2*MAX_DOMAIN_SIZE + header + extra	641	// so we need to have space for 2*MAX_DOMAIN_SIZE + header + extra
361		642
362	u8 data[256]; //TODO
363
364	data[0] = THISNODE->id; //TODO
365	data[1] = seqno >> 7; //TODO
366	data[2] = seqno << 1; //TODO
367
368	int datalen = dns64::decode_len (dlen - (dlen + MAX_LBL_SIZE - 1) / MAX_LBL_SIZE) - 3;
369
370	if (datalen > stream->size ())
371	datalen = stream->size ();
372
373	char enc[256], *encp = enc;	643	char enc[256], *encp = enc;
374		644	encode_header (enc, THISNODE->id, seqno);
375	memcpy (data + 3, stream->begin (), datalen);	645
376	int enclen = dns64::encode (enc, data, datalen + 3);	646	int datalen = cdc62.decode_len (dlen - (dlen + MAX_LBL_SIZE - 1) / MAX_LBL_SIZE - HDRSIZE);
		647
		648	if (datalen > stream.size ())
		649	datalen = stream.size ();
		650
		651	int enclen = cdc62.encode (enc + HDRSIZE, stream.begin (), datalen) + HDRSIZE;
377	stream->remove (datalen);	652	stream.remove (datalen);
378		653
379	while (enclen)	654	while (enclen)
380	{	655	{
381	int lbllen = enclen < MAX_LBL_SIZE ? enclen : MAX_LBL_SIZE;	656	int lbllen = enclen < MAX_LBL_SIZE ? enclen : MAX_LBL_SIZE;
382		657
…		…
387	encp += lbllen;	662	encp += lbllen;
388		663
389	enclen -= lbllen;	664	enclen -= lbllen;
390	}	665	}
391		666
392	const char *suffix = THISNODE->domain;	667	append_domain (*pkt, offs, dns->c->conf->domain);
393
394	// add tunnel domain
395	for (;;)
396	{
397	const char *end = strchr (suffix, '.');
398
399	if (!end)
400	end = suffix + strlen (suffix);
401
402	int len = end - suffix;
403
404	(*pkt)[offs++] = len;
405	memcpy (&((*pkt)[offs]), suffix, len);
406	offs += len;
407
408	if (!*end)
409	break;
410
411	suffix = end + 1;
412	}
413		668
414	(*pkt)[offs++] = 0;	669	(*pkt)[offs++] = 0;
415	(*pkt)[offs++] = RR_TYPE_ANY >> 8; (*pkt)[offs++] = RR_TYPE_ANY;	670	(*pkt)[offs++] = RR_TYPE_ANY >> 8; (*pkt)[offs++] = RR_TYPE_ANY;
		671	(*pkt)[offs++] = RR_CLASS_IN >> 8; (*pkt)[offs++] = RR_CLASS_IN;
		672
		673	pkt->len = offs;
		674	}
		675
		676	void dns_snd::gen_syn_req ()
		677	{
		678	timeout = NOW + INITIAL_SYN_TIMEOUT;
		679
		680	pkt->flags = htons (DEFAULT_CLIENT_FLAGS);
		681	pkt->qdcount = htons (1);
		682
		683	int offs = 6 * 2;
		684
		685	int elen = cdc26.encode ((char *)pkt->at (offs + 1), (u8 *)&dns->cfg, sizeof (dns_cfg));
		686
		687	assert (elen <= MAX_LBL_SIZE);
		688
		689	(*pkt)[offs] = elen;
		690	offs += elen + 1;
		691	append_domain (*pkt, offs, dns->c->conf->domain);
		692
		693	(*pkt)[offs++] = 0;
		694	(*pkt)[offs++] = RR_TYPE_A >> 8; (*pkt)[offs++] = RR_TYPE_A;
416	(*pkt)[offs++] = RR_CLASS_IN >> 8; (*pkt)[offs++] = RR_CLASS_IN;	695	(*pkt)[offs++] = RR_CLASS_IN >> 8; (*pkt)[offs++] = RR_CLASS_IN;
417		696
418	pkt->len = offs;	697	pkt->len = offs;
419	}	698	}
420		699
…		…
439	{	718	{
440	delete pkt;	719	delete pkt;
441	}	720	}
442		721
443	/////////////////////////////////////////////////////////////////////////////	722	/////////////////////////////////////////////////////////////////////////////
444		723
445	struct dns_cfg	724	dns_connection::dns_connection (connection *c)
		725	: c (c)
		726	, rcvdq (MAX_BACKLOG * 2)
		727	, snddq (MAX_BACKLOG)
		728	, tw (this, &dns_connection::time_cb)
446	{	729	{
447	u8 id1, id2, id3;	730	vpn = c->vpn;
448	u8 def_ttl;
449	u8 unused1;
450	u16 max_size;
451	u8 flags1, flags2;
452	};
453		731
		732	established = false;
		733
		734	rcvseq = repseq = sndseq = 0;
		735
		736	last_sent = last_received = 0;
		737	poll_interval = 0.5; // starting here
		738	send_interval = 0.5; // starting rate
		739	min_latency = INITIAL_TIMEOUT;
		740	}
		741
		742	dns_connection::~dns_connection ()
		743	{
		744	for (vector<dns_rcv *>::iterator i = rcvpq.begin ();
		745	i != rcvpq.end ();
		746	++i)
		747	delete *i;
		748	}
		749
454	void connection::dnsv4_receive_rep (struct dns_rcv *r)	750	void dns_connection::receive_rep (dns_rcv *r)
455	{	751	{
		752	if (r->datalen)
		753	{
		754	last_received = NOW;
		755	tw.trigger ();
		756
		757	poll_interval = send_interval;
		758	}
		759	else
		760	{
		761	poll_interval *= 1.5;
		762
		763	if (poll_interval > MAX_POLL_INTERVAL)
		764	poll_interval = MAX_POLL_INTERVAL;
		765	}
		766
456	dns_rcvpq.push_back (r);	767	rcvpq.push_back (r);
457		768
458	redo:	769	redo:
459		770
		771	// find next packet
460	for (vector<dns_rcv *>::iterator i = dns_rcvpq.begin ();	772	for (vector<dns_rcv *>::iterator i = rcvpq.end (); i-- != rcvpq.begin (); )
461	i != dns_rcvpq.end ();
462	++i)
463	if (dns_rcvseq == (*i)->seqno)	773	if (SEQNO_EQ (rcvseq, (*i)->seqno))
464	{	774	{
		775	// enter the packet into our input stream
465	dns_rcv *r = *i;	776	r = *i;
466		777
		778	// remove the oldest packet, look forward, as it's oldest first
		779	for (vector<dns_rcv *>::iterator j = rcvpq.begin (); j != rcvpq.end (); ++j)
		780	if (SEQNO_EQ ((*j)->seqno, rcvseq - MAX_WINDOW))
		781	{
		782	delete *j;
		783	rcvpq.erase (j);
		784	break;
		785	}
		786
467	dns_rcvseq = (dns_rcvseq + 1) & SEQNO_MASK;	787	rcvseq = (rcvseq + 1) & SEQNO_MASK;
468		788
469	if (!dns_snddq && !dns_rcvdq)	789	if (!rcvdq.put (r->data, r->datalen))
470	{	790	{
471	dns_rcvdq = new byte_stream (MAX_BACKLOG * 2);	791	slog (L_ERR, "DNS: !rcvdq.put (r->data, r->datalen)");
472	dns_snddq = new byte_stream (MAX_BACKLOG);	792	abort (); // MUST never overflow, can be caused by data corruption, TODO
473
474	dns_si.set (::conf.dns_forw_host, ::conf.dns_forw_port, PROT_DNSv4);
475	}	793	}
476		794
477	if (!dns_rcvdq->put (r->data, r->datalen))
478	abort (); // MUST never overflow, can be caused by data corruption, TODO
479
480	while (vpn_packet *pkt = dns_rcvdq->get ())	795	while (vpn_packet *pkt = rcvdq.get ())
481	{	796	{
482	sockinfo si;	797	sockinfo si;
483	si.host = 0; si.port = 0; si.prot = PROT_DNSv4;	798	si.host = htonl (c->conf->id); si.port = 0; si.prot = PROT_DNSv4;
484		799
485	vpn->recv_vpn_packet (pkt, si);	800	vpn->recv_vpn_packet (pkt, si);
		801
		802	delete pkt;
486	}	803	}
487	}	804
488	else if ((u32)(*i)->seqno - (u32)dns_rcvseq + MAX_WINDOW > MAX_WINDOW * 2)	805	// check for further packets
489	{
490	//D
491	//abort();
492	printf ("%d erasing %d (%d)\n", THISNODE->id, (u32)(*i)->seqno, dns_rcvseq);
493	dns_rcvpq.erase (i);
494	goto redo;	806	goto redo;
495	}	807	}
496	}	808	}
497		809
498	dns_packet *	810	void
499	vpn::dnsv4_server (dns_packet *pkt)	811	vpn::dnsv4_server (dns_packet &pkt)
500	{	812	{
501	u16 flags = ntohs (pkt->flags);	813	u16 flags = ntohs (pkt.flags);
502		814
503	//memcpy (&((*rep)[0]), &((*pkt)[0]), pkt->len);
504	int offs = 6 * 2; // skip header	815	int offs = 6 * 2; // skip header
505		816
506	pkt->flags = htons (DEFAULT_SERVER_FLAGS | FLAG_RCODE_FORMERR);	817	pkt.flags = htons (DEFAULT_SERVER_FLAGS | FLAG_RCODE_FORMERR);
507		818
508	if (!(flags & (FLAG_RESPONSE | FLAG_OP_MASK | FLAG_TC))	819	if (0 == (flags & (FLAG_RESPONSE | FLAG_OP_MASK))
509	&& pkt->qdcount == htons (1))	820	&& pkt.qdcount == htons (1))
510	{	821	{
511	char qname[MAXSIZE];	822	char qname [MAXSIZE];
512	int qlen = pkt->decode_label ((char *)qname, MAXSIZE - offs, offs);	823	int qlen = pkt.decode_label ((char *)qname, MAXSIZE - offs, offs);
513		824
514	u16 qtype = (*pkt) [offs++] << 8; qtype |= (*pkt) [offs++];	825	u16 qtype = pkt [offs++] << 8; qtype |= pkt [offs++];
515	u16 qclass = (*pkt) [offs++] << 8; qclass |= (*pkt) [offs++];	826	u16 qclass = pkt [offs++] << 8; qclass |= pkt [offs++];
516		827
517	pkt->qdcount = htons (1);	828	pkt.qdcount = htons (1);
518	pkt->ancount = 0;	829	pkt.ancount = 0;
519	pkt->nscount = 0; // should be self, as other nameservers reply like this	830	pkt.nscount = 0; // should be self, as other nameservers reply like this
520	pkt->arcount = 0; // a record for self, as other nameservers reply like this	831	pkt.arcount = 0; // a record for self, as other nameservers reply like this
521		832
522	pkt->flags = htons (DEFAULT_SERVER_FLAGS | FLAG_RCODE_NXDOMAIN);	833	pkt.flags = htons (DEFAULT_SERVER_FLAGS | FLAG_RCODE_SERVFAIL);
523		834
524	int dlen = strlen (THISNODE->domain);	835	int dlen = strlen (THISNODE->domain);
525		836
526	if (qclass == RR_CLASS_IN	837	if (qclass == RR_CLASS_IN
527	&& (qtype == RR_TYPE_ANY || qtype == RR_TYPE_TXT)
528	&& qlen > dlen + 1	838	&& qlen > dlen + 1
529	&& !memcmp (qname + qlen - dlen - 1, THISNODE->domain, dlen))	839	&& !memcmp (qname + qlen - (dlen + 1), THISNODE->domain, dlen))
530	{	840	{
531	// correct class, domain: parse	841	// now generate reply
532	u8 data[MAXSIZE];	842	pkt.ancount = htons (1); // one answer RR
533	int datalen = dns64::decode (data, qname, qlen - dlen - 1);	843	pkt.flags = htons (DEFAULT_SERVER_FLAGS | FLAG_RCODE_OK);
534		844
535	int client = data[0];	845	if ((qtype == RR_TYPE_ANY
536	int seqno = ((data[1] << 7) | (data[2] >> 1)) & SEQNO_MASK;	846	|| qtype == RR_TYPE_TXT
537		847	|| qtype == RR_TYPE_NULL)
538	if (0 < client && client <= conns.size ())	848	&& qlen > dlen + 1 + HDRSIZE)
539	{	849	{
		850	// correct class, domain: parse
		851	int client, seqno;
		852	decode_header (qname, client, seqno);
		853
		854	u8 data[MAXSIZE];
		855	int datalen = cdc62.decode (data, qname + HDRSIZE, qlen - (dlen + 1 + HDRSIZE));
		856
		857	if (0 < client && client <= conns.size ())
		858	{
540	connection *c = conns [client - 1];	859	connection *c = conns [client - 1];
		860	dns_connection *dns = c->dns;
		861	dns_rcv *rcv;
541		862
542	redo:	863	if (dns)
543
544	for (vector<dns_rcv *>::iterator i = c->dns_rcvpq.begin ();
545	i != c->dns_rcvpq.end ();
546	++i)	864	{
		865	for (vector<dns_rcv *>::iterator i = dns->rcvpq.end (); i-- != dns->rcvpq.begin (); )
547	if ((*i)->seqno == seqno)	866	if (SEQNO_EQ ((*i)->seqno, seqno))
		867	{
		868	// already seen that request: simply reply with the cached reply
		869	dns_rcv *r = *i;
		870
		871	slog (L_DEBUG, "DNS: duplicate packet received ID %d, SEQ %d", htons (r->pkt->id), seqno);
		872
		873	// refresh header & id, as the retry count could have changed
		874	memcpy (r->pkt->at (6 * 2 + 1), pkt.at (6 * 2 + 1), HDRSIZE);
		875	r->pkt->id = pkt.id;
		876
		877	memcpy (pkt.at (0), r->pkt->at (0), offs = r->pkt->len);
		878
		879	goto duplicate_request;
		880	}
		881
		882	// new packet, queue
		883	rcv = new dns_rcv (seqno, data, datalen);
		884	dns->receive_rep (rcv);
		885	}
		886
548	{	887	{
549	// already seen that request: simply reply with the cached reply	888	pkt [offs++] = 0xc0; pkt [offs++] = 6 * 2; // refer to name in query section
550	dns_rcv *r = *i;
551		889
552	printf ("DUPLICATE %d\n", htons (r->pkt->id));//D	890	int rtype = dns ? dns->cfg.rrtype : RR_TYPE_A;
		891	pkt [offs++] = rtype >> 8; pkt [offs++] = rtype; // type
		892	pkt [offs++] = RR_CLASS_IN >> 8; pkt [offs++] = RR_CLASS_IN; // class
		893	pkt [offs++] = 0; pkt [offs++] = 0;
		894	pkt [offs++] = 0; pkt [offs++] = dns ? dns->cfg.def_ttl : 0; // TTL
553		895
		896	int rdlen_offs = offs += 2;
		897
		898	if (dns)
		899	{
		900	int dlen = ntohs (dns->cfg.max_size) - offs;
		901
		902	// bind doesn't compress well, so reduce further by one label length
		903	dlen -= qlen;
		904
		905	// only put data into in-order sequence packets, if
		906	// we receive out-of-order packets we generate empty
		907	// replies
		908	//printf ("%d - %d & %x (=%d) < %d\n", seqno, dns->repseq, SEQNO_MASK, (seqno - dns->repseq) & SEQNO_MASK, MAX_WINDOW);//D
		909	if (((seqno - dns->repseq) & SEQNO_MASK) <= MAX_WINDOW)
		910	{
		911	dns->repseq = seqno;
		912
		913	while (dlen > 1 && !dns->snddq.empty ())
		914	{
		915	int txtlen = dlen <= 255 ? dlen - 1 : 255;
		916
		917	if (txtlen > dns->snddq.size ())
		918	txtlen = dns->snddq.size ();
		919
		920	pkt[offs++] = txtlen;
		921	memcpy (pkt.at (offs), dns->snddq.begin (), txtlen);
		922	offs += txtlen;
		923	dns->snddq.remove (txtlen);
		924
		925	dlen -= txtlen + 1;
		926	}
		927	}
		928
		929	// avoid completely empty TXT rdata
		930	if (offs == rdlen_offs)
		931	pkt[offs++] = 0;
		932
		933	slog (L_NOISE, "DNS: snddq %d", dns->snddq.size ());
		934	}
		935	else
		936	{
		937	// send RST
		938	pkt [offs++] = CMD_IP_1; pkt [offs++] = CMD_IP_2; pkt [offs++] = CMD_IP_3;
		939	pkt [offs++] = CMD_IP_RST;
		940	}
		941
		942	int rdlen = offs - rdlen_offs;
		943
		944	pkt [rdlen_offs - 2] = rdlen >> 8;
		945	pkt [rdlen_offs - 1] = rdlen;
		946
		947	if (dns)
		948	{
		949	// now update dns_rcv copy
554	offs = r->pkt->len;	950	rcv->pkt->len = offs;
555	memcpy (pkt->at (0), r->pkt->at (0), offs);	951	memcpy (rcv->pkt->at (0), pkt.at (0), offs);
556	goto duplicate_request;	952	}
557	}	953	}
558		954
559	// new packet, queue	955	duplicate_request: ;
560	dns_rcv *rcv = new dns_rcv (seqno, data + 3, datalen - 3);	956	}
561	c->dnsv4_receive_rep (rcv);	957	else
562
563	// now generate reply
564	pkt->ancount = htons (1); // one answer RR
565	pkt->flags = htons (DEFAULT_SERVER_FLAGS | FLAG_RCODE_OK);	958	pkt.flags = htons (DEFAULT_SERVER_FLAGS | FLAG_RCODE_FORMERR);
		959	}
		960	else if (qtype == RR_TYPE_A
		961	&& qlen > dlen + 1 + cdc26.encode_len (sizeof (dns_cfg)))
		962	{
		963	dns_cfg cfg;
		964	cdc26.decode ((u8 *)&cfg, qname, cdc26.encode_len (sizeof (dns_cfg)));
		965	int client = ntohs (cfg.client);
566		966
567	(*pkt) [offs++] = 0xc0;
568	(*pkt) [offs++] = 6 * 2; // same as in query section	967	pkt [offs++] = 0xc0; pkt [offs++] = 6 * 2; // refer to name in query section
569		968
570	(*pkt) [offs++] = RR_TYPE_TXT >> 8; (*pkt) [offs++] = RR_TYPE_TXT;	969	pkt [offs++] = RR_TYPE_A >> 8; pkt [offs++] = RR_TYPE_A; // type
571	(*pkt) [offs++] = RR_CLASS_IN >> 8; (*pkt) [offs++] = RR_CLASS_IN;	970	pkt [offs++] = RR_CLASS_IN >> 8; pkt [offs++] = RR_CLASS_IN; // class
572
573	(*pkt) [offs++] = 0; (*pkt) [offs++] = 0;	971	pkt [offs++] = 0; pkt [offs++] = 0;
574	(*pkt) [offs++] = 0; (*pkt) [offs++] = 0; // TTL	972	pkt [offs++] = 0; pkt [offs++] = cfg.def_ttl; // TTL
		973	pkt [offs++] = 0; pkt [offs++] = 4; // rdlength
575		974
576	int dlen = MAX_PKT_SIZE - offs - 2;	975	slog (L_INFO, _("DNS: client %d connects"), client);
577		976
578	// bind doesn't compress well, so reduce further by one label length	977	pkt [offs++] = CMD_IP_1; pkt [offs++] = CMD_IP_2; pkt [offs++] = CMD_IP_3;
579	dlen -= qlen;	978	pkt [offs++] = CMD_IP_REJ;
580		979
581	int rdlen_offs = offs += 2;	980	if (0 < client && client <= conns.size ())
582
583	while (c->dns_snddq
584	&& !c->dns_snddq->empty ()
585	&& dlen > 1)
586	{	981	{
587	int txtlen = dlen <= 255 ? dlen - 1 : 255;	982	connection *c = conns [client - 1];
588		983
589	if (txtlen > c->dns_snddq->size ())	984	if (cfg.valid ())
590	txtlen = c->dns_snddq->size ();	985	{
		986	pkt [offs - 1] = CMD_IP_SYN;
591		987
592	(*pkt)[offs++] = txtlen;	988	delete c->dns;
593	memcpy (pkt->at (offs), c->dns_snddq->begin (), txtlen);	989	c->dns = new dns_connection (c);
594	offs += txtlen;	990	c->dns->cfg = cfg;
595	c->dns_snddq->remove (txtlen);	991	}
596
597	dlen -= txtlen + 1;
598	}	992	}
599
600	// avoid empty TXT rdata
601	if (offs == rdlen_offs)
602	(*pkt)[offs++] = 0;
603
604	int rdlen = offs - rdlen_offs;
605
606	(*pkt) [rdlen_offs - 2] = rdlen >> 8;
607	(*pkt) [rdlen_offs - 1] = rdlen;
608
609	// now update dns_rcv copy
610	rcv->pkt->len = offs;
611	memcpy (rcv->pkt->at (0), pkt->at (0), offs);
612
613	duplicate_request: ;
614	}	993	}
615	else
616	pkt->flags = htons (DEFAULT_SERVER_FLAGS | FLAG_RCODE_FORMERR);
617	}	994	}
618		995
619	pkt->len = offs;	996	pkt.len = offs;
620	}	997	}
621
622	return pkt;
623	}	998	}
624		999
625	void	1000	void
626	vpn::dnsv4_client (dns_packet *pkt)	1001	vpn::dnsv4_client (dns_packet &pkt)
627	{	1002	{
628	u16 flags = ntohs (pkt->flags);	1003	u16 flags = ntohs (pkt.flags);
629	int offs = 6 * 2; // skip header	1004	int offs = 6 * 2; // skip header
630		1005
631	pkt->qdcount = ntohs (pkt->qdcount);	1006	pkt.qdcount = ntohs (pkt.qdcount);
632	pkt->ancount = ntohs (pkt->ancount);	1007	pkt.ancount = ntohs (pkt.ancount);
633		1008
634	// go through our request list and find the corresponding request	1009	// go through our request list and find the corresponding request
635	for (vector<dns_req *>::iterator i = dns_sndpq.begin ();	1010	for (vector<dns_snd *>::iterator i = dns_sndpq.begin ();
636	i != dns_sndpq.end ();	1011	i != dns_sndpq.end ();
637	++i)	1012	++i)
638	if ((*i)->pkt->id == pkt->id)	1013	if ((*i)->pkt->id == pkt.id)
639	{	1014	{
		1015	dns_connection *dns = (*i)->dns;
640	connection *c = (*i)->conn;	1016	connection *c = dns->c;
641	int seqno = (*i)->seqno;	1017	int seqno = (*i)->seqno;
642	u8 data[MAXSIZE], *datap = data;	1018	u8 data[MAXSIZE], *datap = data;
643		1019
		1020	if ((*i)->retry)
		1021	{
		1022	dns->send_interval *= 1.01;
		1023	if (dns->send_interval > MAX_SEND_INTERVAL)
		1024	dns->send_interval = MAX_SEND_INTERVAL;
		1025	}
		1026	else
		1027	{
		1028	#if 0
		1029	dns->send_interval *= 0.999;
		1030	#endif
		1031	// the latency surely puts an upper bound on
		1032	// the minimum send interval
		1033	double latency = NOW - (*i)->sent;
		1034
		1035	if (latency < dns->min_latency)
		1036	dns->min_latency = latency;
		1037
		1038	if (dns->send_interval > dns->min_latency * LATENCY_FACTOR)
		1039	dns->send_interval = dns->min_latency * LATENCY_FACTOR;
		1040
		1041	if (dns->send_interval < MIN_SEND_INTERVAL)
		1042	dns->send_interval = MIN_SEND_INTERVAL;
		1043	}
		1044
644	delete *i;	1045	delete *i;
645	dns_sndpq.erase (i);	1046	dns_sndpq.erase (i);
646		1047
647	if (flags & (FLAG_RESPONSE | FLAG_OP_MASK | FLAG_TC))	1048	if (flags & FLAG_RESPONSE && !(flags & FLAG_OP_MASK))
648	{	1049	{
649	char qname[MAXSIZE];	1050	char qname[MAXSIZE];
650		1051
651	while (pkt->qdcount-- && offs < MAXSIZE - 4)	1052	while (pkt.qdcount-- && offs < MAXSIZE - 4)
652	{	1053	{
653	int qlen = pkt->decode_label ((char *)qname, MAXSIZE - offs, offs);	1054	int qlen = pkt.decode_label ((char *)qname, MAXSIZE - offs, offs);
654	offs += 4; // skip qtype, qclass	1055	offs += 4; // skip qtype, qclass
655	}	1056	}
656		1057
657	while (pkt->ancount-- && offs < MAXSIZE - 10)	1058	while (pkt.ancount-- && offs < MAXSIZE - 10 && datap)
658	{	1059	{
659	pkt->decode_label ((char *)qname, MAXSIZE - offs, offs);	1060	int qlen = pkt.decode_label ((char *)qname, MAXSIZE - offs, offs);
660		1061
661	u16 qtype = (*pkt) [offs++] << 8; qtype |= (*pkt) [offs++];	1062	u16 qtype = pkt [offs++] << 8; qtype |= pkt [offs++];
662	u16 qclass = (*pkt) [offs++] << 8; qclass |= (*pkt) [offs++];	1063	u16 qclass = pkt [offs++] << 8; qclass |= pkt [offs++];
663	u32 ttl = (*pkt) [offs++] << 24;	1064	u32 ttl = pkt [offs++] << 24;
664	ttl |= (*pkt) [offs++] << 16;	1065	ttl |= pkt [offs++] << 16;
665	ttl |= (*pkt) [offs++] << 8;	1066	ttl |= pkt [offs++] << 8;
666	ttl |= (*pkt) [offs++];	1067	ttl |= pkt [offs++];
667
668	u16 rdlen = (*pkt) [offs++] << 8; rdlen |= (*pkt) [offs++];	1068	u16 rdlen = pkt [offs++] << 8; rdlen |= pkt [offs++];
669		1069
670	if (rdlen <= MAXSIZE - offs)	1070	if (qtype == RR_TYPE_NULL || qtype == RR_TYPE_TXT)
671	{	1071	{
672	// decode bytes, finally	1072	if (rdlen <= MAXSIZE - offs)
673
674	while (rdlen)
675	{	1073	{
		1074	// decode bytes, finally
		1075
		1076	while (rdlen)
		1077	{
676	int txtlen = (*pkt) [offs++];	1078	int txtlen = pkt [offs++];
677		1079
678	assert (txtlen + offs < MAXSIZE - 1);	1080	assert (txtlen + offs < MAXSIZE - 1);
679		1081
680	memcpy (datap, pkt->at (offs), txtlen);	1082	memcpy (datap, pkt.at (offs), txtlen);
681	datap += txtlen; offs += txtlen;	1083	datap += txtlen; offs += txtlen;
682		1084
683	rdlen -= txtlen + 1;	1085	rdlen -= txtlen + 1;
		1086	}
684	}	1087	}
685
686	}	1088	}
		1089	else if (qtype == RR_TYPE_A)
		1090	{
		1091	u8 ip [4];
687		1092
		1093	ip [0] = pkt [offs++];
		1094	ip [1] = pkt [offs++];
		1095	ip [2] = pkt [offs++];
		1096	ip [3] = pkt [offs++];
		1097
		1098	if (ip [0] == CMD_IP_1
		1099	&& ip [1] == CMD_IP_2
		1100	&& ip [2] == CMD_IP_3)
		1101	{
		1102	slog (L_TRACE, _("DNS: got tunnel meta command %02x"), ip [3]);
		1103
		1104	if (ip [3] == CMD_IP_RST)
		1105	{
		1106	slog (L_DEBUG, _("DNS: got tunnel RST request"));
		1107
		1108	delete dns; c->dns = 0;
		1109
		1110	return;
		1111	}
		1112	else if (ip [3] == CMD_IP_SYN)
		1113	{
		1114	slog (L_DEBUG, _("DNS: got tunnel SYN reply, server likes us."));
		1115	dns->established = true;
		1116	}
		1117	else if (ip [3] == CMD_IP_REJ)
		1118	{
		1119	slog (L_DEBUG, _("DNS: got tunnel REJ reply, server does not like us, aborting."));
		1120	abort ();
		1121	}
		1122	else
		1123	slog (L_INFO, _("DNS: got unknown meta command %02x"), ip [3]);
		1124	}
		1125	else
		1126	slog (L_INFO, _("DNS: got spurious a record %d.%d.%d.%d"),
		1127	ip [0], ip [1], ip [2], ip [3]);
		1128
		1129	return;
		1130	}
		1131
		1132	int client, rseqno;
		1133	decode_header (qname, client, rseqno);
		1134
		1135	if (client != THISNODE->id)
		1136	{
		1137	slog (L_INFO, _("DNS: got dns tunnel response with wrong clientid, ignoring"));
		1138	datap = 0;
		1139	}
		1140	else if (rseqno != seqno)
		1141	{
		1142	slog (L_DEBUG, _("DNS: got dns tunnel response with wrong seqno, badly caching nameserver?"));
		1143	datap = 0;
		1144	}
688	}	1145	}
689	}	1146	}
690		1147
691	// todo: pkt now used	1148	// todo: pkt now used
		1149	if (datap)
692	c->dnsv4_receive_rep (new dns_rcv (seqno, data, datap - data));	1150	dns->receive_rep (new dns_rcv (seqno, data, datap - data));
693		1151
694	break;	1152	break;
695	}	1153	}
696
697	delete pkt;
698	}	1154	}
699		1155
700	void	1156	void
701	vpn::dnsv4_ev (io_watcher &w, short revents)	1157	vpn::dnsv4_ev (io_watcher &w, short revents)
702	{	1158	{
…		…
704	{	1160	{
705	dns_packet *pkt = new dns_packet;	1161	dns_packet *pkt = new dns_packet;
706	struct sockaddr_in sa;	1162	struct sockaddr_in sa;
707	socklen_t sa_len = sizeof (sa);	1163	socklen_t sa_len = sizeof (sa);
708		1164
709	pkt->len = recvfrom (w.fd, &((*pkt)[0]), MAXSIZE, 0, (sockaddr *)&sa, &sa_len);	1165	pkt->len = recvfrom (w.fd, pkt->at (0), MAXSIZE, 0, (sockaddr *)&sa, &sa_len);
710		1166
711	if (pkt->len > 0)	1167	if (pkt->len > 0)
712	{	1168	{
713	if (pkt->flags & htons (FLAG_TC))	1169	if (ntohs (pkt->flags) & FLAG_RESPONSE)
		1170	dnsv4_client (*pkt);
		1171	else
714	{	1172	{
715	slog (L_WARN, _("DNS request/response truncated, check protocol settings."));	1173	dnsv4_server (*pkt);
716	//TODO connection reset	1174	sendto (w.fd, pkt->at (0), pkt->len, 0, (sockaddr *)&sa, sa_len);
717	}	1175	}
718		1176
719	if (THISNODE->dns_port)	1177	delete pkt;
720	{
721	pkt = dnsv4_server (pkt);
722	sendto (w.fd, &((*pkt)[0]), pkt->len, 0, (sockaddr *)&sa, sa_len);
723	}
724	else
725	dnsv4_client (pkt);
726	}	1178	}
727	}	1179	}
728	}	1180	}
729		1181
730	bool	1182	bool
731	connection::send_dnsv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)	1183	vpn::send_dnsv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
732	{	1184	{
733	// never initialized	1185	int client = ntohl (si.host);
734	if (!dns_snddq && !dns_rcvdq)
735	{
736	dns_rcvdq = new byte_stream (MAX_BACKLOG * 2);
737	dns_snddq = new byte_stream (MAX_BACKLOG);
738		1186
739	//dns_rcvseq = dns_sndseq = 0;	1187	assert (0 < client && client <= conns.size ());
740		1188
741	dns_si.set (::conf.dns_forw_host, ::conf.dns_forw_port, PROT_DNSv4);	1189	connection *c = conns [client - 1];
742	}	1190
		1191	if (!c->dns)
		1192	c->dns = new dns_connection (c);
743		1193
744	if (!dns_snddq->put (pkt))	1194	if (c->dns->snddq.put (pkt))
745	return false;	1195	c->dns->tw.trigger ();
746		1196
747	// start timer if neccessary	1197	// always return true even if the buffer overflows
748	if (!THISNODE->dns_port && !dnsv4_tw.active)
749	dnsv4_cb (dnsv4_tw);
750
751	return true;	1198	return true;
752	}	1199	}
753		1200
754	void	1201	void
		1202	connection::dnsv4_reset_connection ()
		1203	{
		1204	//delete dns; dns = 0; //TODO
		1205	}
		1206
		1207	#define NEXT(w) do { if (next > (w)) next = w; } while (0)
		1208
		1209	void
755	connection::dnsv4_cb (time_watcher &w)	1210	dns_connection::time_cb (time_watcher &w)
756	{	1211	{
		1212	// servers have to be polled
		1213	if (THISNODE->dns_port)
		1214	return;
		1215
757	// check for timeouts and (re)transmit	1216	// check for timeouts and (re)transmit
758	tstamp next = NOW + 60;	1217	tstamp next = NOW + poll_interval;
759	dns_req *send = 0;	1218	dns_snd *send = 0;
760		1219
761	for (vector<dns_req *>::iterator i = vpn->dns_sndpq.begin ();	1220	for (vector<dns_snd *>::iterator i = vpn->dns_sndpq.begin ();
762	i != vpn->dns_sndpq.end ();	1221	i != vpn->dns_sndpq.end ();
763	++i)	1222	++i)
764	{	1223	{
765	dns_req *r = *i;	1224	dns_snd *r = *i;
766		1225
767	if (r->next <= NOW)	1226	if (r->timeout <= NOW)
768	{	1227	{
769	if (!send)	1228	if (!send)
770	{	1229	{
771	send = r;	1230	send = r;
772		1231
773	if (r->retry)//D
774	printf ("req %d, retry %d\n", r->pkt->id, r->retry);
775	r->retry++;	1232	r->retry++;
776	r->next = NOW + r->retry;	1233	r->timeout = NOW + (r->retry * min_latency * TIMEOUT_FACTOR);
		1234
		1235	// the following code changes the query section a bit, forcing
		1236	// the forwarder to generate a new request
		1237	if (r->stdhdr)
		1238	{
		1239	//printf ("reencoded header for ID %d retry %d:%d:%d (%p)\n", htons (r->pkt->id), THISNODE->id, r->seqno, r->retry);
		1240	//encode_header ((char *)r->pkt->at (6 * 2 + 1), THISNODE->id, r->seqno, r->retry);
		1241	}
777	}	1242	}
778	}	1243	}
779		1244	else
780	if (r->next < next)	1245	NEXT (r->timeout);
781	next = r->next;
782	}	1246	}
783		1247
784	if (!send	1248	if (!send)
		1249	{
		1250	// generate a new packet, if wise
		1251
		1252	if (!established)
		1253	{
		1254	if (vpn->dns_sndpq.empty ())
		1255	{
		1256	send = new dns_snd (this);
		1257
		1258	cfg.reset (THISNODE->id);
		1259	send->gen_syn_req ();
		1260	}
		1261	}
785	&& vpn->dns_sndpq.size () < MAX_OUTSTANDING)	1262	else if (vpn->dns_sndpq.size () < MAX_OUTSTANDING
786	{	1263	&& !SEQNO_EQ (rcvseq, sndseq - (MAX_WINDOW - 1)))
		1264	{
		1265	if (last_sent + send_interval <= NOW)
		1266	{
		1267	//printf ("sending data request etc.\n"); //D
		1268	if (!snddq.empty () || last_received + 1. > NOW)
		1269	{
		1270	poll_interval = send_interval;
		1271	NEXT (NOW + send_interval);
		1272	}
		1273
787	send = new dns_req (this);	1274	send = new dns_snd (this);
788	send->gen_stream_req (dns_sndseq, dns_snddq);	1275	send->gen_stream_req (sndseq, snddq);
		1276	send->timeout = NOW + min_latency * TIMEOUT_FACTOR;
		1277
		1278	sndseq = (sndseq + 1) & SEQNO_MASK;
		1279	}
		1280	else
		1281	NEXT (last_sent + send_interval);
		1282	}
		1283
		1284	if (send)
789	vpn->dns_sndpq.push_back (send);	1285	vpn->dns_sndpq.push_back (send);
790
791	dns_sndseq = (dns_sndseq + 1) & SEQNO_MASK;
792	}	1286	}
793
794	tstamp min_next = NOW + (1. / (tstamp)MAX_RATE);
795		1287
796	if (send)	1288	if (send)
797	{	1289	{
798	dns_packet *pkt = send->pkt;	1290	last_sent = NOW;
799		1291	sendto (vpn->dnsv4_fd,
800	next = min_next;	1292	send->pkt->at (0), send->pkt->len, 0,
801		1293	vpn->dns_forwarder.sav4 (), vpn->dns_forwarder.salenv4 ());
802	sendto (vpn->dnsv4_fd, &((*pkt)[0]), pkt->len, 0, dns_si.sav4 (), dns_si.salenv4 ());
803	}	1294	}
804	else if (next < min_next)	1295
805	next = min_next;	1296	slog (L_NOISE, "DNS: pi %f si %f N %f (%d:%d %d)",
		1297	poll_interval, send_interval, next - NOW,
		1298	vpn->dns_sndpq.size (), snddq.size (),
		1299	rcvpq.size ());
		1300
		1301	// TODO: no idea when this happens, but when next < NOW, we have a problem
		1302	if (next < NOW + 0.001)
		1303	next = NOW + 0.1;
806		1304
807	w.start (next);	1305	w.start (next);
808	}	1306	}
809		1307
810	#endif	1308	#endif

Diff Legend

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