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

Diff Legend

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