/src/avahi/avahi-core/dns.c
Line | Count | Source |
1 | | /*** |
2 | | This file is part of avahi. |
3 | | |
4 | | avahi is free software; you can redistribute it and/or modify it |
5 | | under the terms of the GNU Lesser General Public License as |
6 | | published by the Free Software Foundation; either version 2.1 of the |
7 | | License, or (at your option) any later version. |
8 | | |
9 | | avahi is distributed in the hope that it will be useful, but WITHOUT |
10 | | ANY WARRANTY; without even the implied warranty of MERCHANTABILITY |
11 | | or FITNESS FOR A PARTICULAR PURPOSE. See the GNU Lesser General |
12 | | Public License for more details. |
13 | | |
14 | | You should have received a copy of the GNU Lesser General Public |
15 | | License along with avahi; if not, write to the Free Software |
16 | | Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 |
17 | | USA. |
18 | | ***/ |
19 | | |
20 | | #ifdef HAVE_CONFIG_H |
21 | | #include <config.h> |
22 | | #endif |
23 | | |
24 | | #include <stdlib.h> |
25 | | #include <string.h> |
26 | | #include <stdio.h> |
27 | | #include <assert.h> |
28 | | |
29 | | #include <sys/types.h> |
30 | | #include <netinet/in.h> |
31 | | |
32 | | #include <avahi-common/defs.h> |
33 | | #include <avahi-common/domain.h> |
34 | | #include <avahi-common/malloc.h> |
35 | | |
36 | | #include "dns.h" |
37 | | #include "log.h" |
38 | | |
39 | 5.46k | AvahiDnsPacket* avahi_dns_packet_new(unsigned mtu) { |
40 | 5.46k | AvahiDnsPacket *p; |
41 | 5.46k | size_t max_size; |
42 | | |
43 | 5.46k | if (mtu <= 0) |
44 | 0 | max_size = AVAHI_DNS_PACKET_SIZE_MAX; |
45 | 5.46k | else if (mtu >= AVAHI_DNS_PACKET_EXTRA_SIZE) |
46 | 5.46k | max_size = mtu - AVAHI_DNS_PACKET_EXTRA_SIZE; |
47 | 0 | else |
48 | 0 | max_size = 0; |
49 | | |
50 | 5.46k | if (max_size < AVAHI_DNS_PACKET_HEADER_SIZE) |
51 | 16 | max_size = AVAHI_DNS_PACKET_HEADER_SIZE; |
52 | | |
53 | 5.46k | if (!(p = avahi_malloc(sizeof(AvahiDnsPacket) + max_size))) |
54 | 0 | return p; |
55 | | |
56 | 5.46k | p->size = p->rindex = AVAHI_DNS_PACKET_HEADER_SIZE; |
57 | 5.46k | p->max_size = max_size; |
58 | 5.46k | p->res_size = 0; |
59 | 5.46k | p->name_table = NULL; |
60 | 5.46k | p->data = NULL; |
61 | | |
62 | 5.46k | memset(AVAHI_DNS_PACKET_DATA(p), 0, p->size); |
63 | 5.46k | return p; |
64 | 5.46k | } |
65 | | |
66 | 0 | AvahiDnsPacket* avahi_dns_packet_new_query(unsigned mtu) { |
67 | 0 | AvahiDnsPacket *p; |
68 | |
|
69 | 0 | if (!(p = avahi_dns_packet_new(mtu))) |
70 | 0 | return NULL; |
71 | | |
72 | 0 | avahi_dns_packet_set_field(p, AVAHI_DNS_FIELD_FLAGS, AVAHI_DNS_FLAGS(0, 0, 0, 0, 0, 0, 0, 0, 0, 0)); |
73 | 0 | return p; |
74 | 0 | } |
75 | | |
76 | 0 | AvahiDnsPacket* avahi_dns_packet_new_response(unsigned mtu, int aa) { |
77 | 0 | AvahiDnsPacket *p; |
78 | |
|
79 | 0 | if (!(p = avahi_dns_packet_new(mtu))) |
80 | 0 | return NULL; |
81 | | |
82 | 0 | avahi_dns_packet_set_field(p, AVAHI_DNS_FIELD_FLAGS, AVAHI_DNS_FLAGS(1, 0, aa, 0, 0, 0, 0, 0, 0, 0)); |
83 | 0 | return p; |
84 | 0 | } |
85 | | |
86 | 0 | AvahiDnsPacket* avahi_dns_packet_new_reply(AvahiDnsPacket* p, unsigned mtu, int copy_queries, int aa) { |
87 | 0 | AvahiDnsPacket *r; |
88 | 0 | assert(p); |
89 | | |
90 | 0 | if (!(r = avahi_dns_packet_new_response(mtu, aa))) |
91 | 0 | return NULL; |
92 | | |
93 | 0 | if (copy_queries) { |
94 | 0 | unsigned saved_rindex; |
95 | 0 | uint32_t n; |
96 | |
|
97 | 0 | saved_rindex = p->rindex; |
98 | 0 | p->rindex = AVAHI_DNS_PACKET_HEADER_SIZE; |
99 | |
|
100 | 0 | for (n = avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_QDCOUNT); n > 0; n--) { |
101 | 0 | AvahiKey *k; |
102 | 0 | int unicast_response; |
103 | |
|
104 | 0 | if ((k = avahi_dns_packet_consume_key(p, &unicast_response))) { |
105 | 0 | avahi_dns_packet_append_key(r, k, unicast_response); |
106 | 0 | avahi_key_unref(k); |
107 | 0 | } |
108 | 0 | } |
109 | |
|
110 | 0 | p->rindex = saved_rindex; |
111 | |
|
112 | 0 | avahi_dns_packet_set_field(r, AVAHI_DNS_FIELD_QDCOUNT, avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_QDCOUNT)); |
113 | 0 | } |
114 | |
|
115 | 0 | avahi_dns_packet_set_field(r, AVAHI_DNS_FIELD_ID, avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_ID)); |
116 | |
|
117 | 0 | avahi_dns_packet_set_field(r, AVAHI_DNS_FIELD_FLAGS, |
118 | 0 | (avahi_dns_packet_get_field(r, AVAHI_DNS_FIELD_FLAGS) & ~AVAHI_DNS_FLAG_OPCODE) | |
119 | 0 | (avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_FLAGS) & AVAHI_DNS_FLAG_OPCODE)); |
120 | |
|
121 | 0 | return r; |
122 | 0 | } |
123 | | |
124 | | |
125 | 5.46k | void avahi_dns_packet_free(AvahiDnsPacket *p) { |
126 | 5.46k | assert(p); |
127 | | |
128 | 5.46k | if (p->name_table) |
129 | 603 | avahi_hashmap_free(p->name_table); |
130 | | |
131 | 5.46k | avahi_free(p); |
132 | 5.46k | } |
133 | | |
134 | 0 | void avahi_dns_packet_set_field(AvahiDnsPacket *p, unsigned idx, uint16_t v) { |
135 | 0 | assert(p); |
136 | 0 | assert(idx < AVAHI_DNS_PACKET_HEADER_SIZE); |
137 | | |
138 | 0 | ((uint16_t*) AVAHI_DNS_PACKET_DATA(p))[idx] = htons(v); |
139 | 0 | } |
140 | | |
141 | 0 | uint16_t avahi_dns_packet_get_field(AvahiDnsPacket *p, unsigned idx) { |
142 | 0 | assert(p); |
143 | 0 | assert(idx < AVAHI_DNS_PACKET_HEADER_SIZE); |
144 | | |
145 | 0 | return ntohs(((uint16_t*) AVAHI_DNS_PACKET_DATA(p))[idx]); |
146 | 0 | } |
147 | | |
148 | 0 | void avahi_dns_packet_inc_field(AvahiDnsPacket *p, unsigned idx) { |
149 | 0 | assert(p); |
150 | 0 | assert(idx < AVAHI_DNS_PACKET_HEADER_SIZE); |
151 | | |
152 | 0 | avahi_dns_packet_set_field(p, idx, avahi_dns_packet_get_field(p, idx) + 1); |
153 | 0 | } |
154 | | |
155 | | |
156 | 4.44k | static void name_table_cleanup(void *key, void *value, void *user_data) { |
157 | 4.44k | AvahiDnsPacket *p = user_data; |
158 | | |
159 | 4.44k | if ((uint8_t*) value >= AVAHI_DNS_PACKET_DATA(p) + p->size) |
160 | 2.92k | avahi_hashmap_remove(p->name_table, key); |
161 | 4.44k | } |
162 | | |
163 | 251 | void avahi_dns_packet_cleanup_name_table(AvahiDnsPacket *p) { |
164 | 251 | if (p->name_table) |
165 | 251 | avahi_hashmap_foreach(p->name_table, name_table_cleanup, p); |
166 | 251 | } |
167 | | |
168 | 2.64k | uint8_t* avahi_dns_packet_append_name(AvahiDnsPacket *p, const char *name) { |
169 | 2.64k | uint8_t *d, *saved_ptr = NULL; |
170 | 2.64k | size_t saved_size; |
171 | | |
172 | 2.64k | assert(p); |
173 | 2.64k | assert(name); |
174 | | |
175 | 2.64k | saved_size = p->size; |
176 | 2.64k | saved_ptr = avahi_dns_packet_extend(p, 0); |
177 | | |
178 | 16.6k | while (*name) { |
179 | 14.1k | uint8_t* prev; |
180 | 14.1k | const char *pname; |
181 | 14.1k | char label[64], *u; |
182 | | |
183 | | /* Check whether we can compress this name. */ |
184 | | |
185 | 14.1k | if (p->name_table && (prev = avahi_hashmap_lookup(p->name_table, name))) { |
186 | 85 | unsigned idx; |
187 | | |
188 | 85 | assert(prev >= AVAHI_DNS_PACKET_DATA(p)); |
189 | 85 | idx = (unsigned) (prev - AVAHI_DNS_PACKET_DATA(p)); |
190 | | |
191 | 85 | assert(idx < p->size); |
192 | | |
193 | 85 | if (idx < 0x4000) { |
194 | 85 | uint8_t *t; |
195 | 85 | if (!(t = (uint8_t*) avahi_dns_packet_extend(p, sizeof(uint16_t)))) |
196 | 11 | return NULL; |
197 | | |
198 | 74 | t[0] = (uint8_t) ((0xC000 | idx) >> 8); |
199 | 74 | t[1] = (uint8_t) idx; |
200 | 74 | return saved_ptr; |
201 | 85 | } |
202 | 85 | } |
203 | | |
204 | 14.0k | pname = name; |
205 | | |
206 | 14.0k | if (!(avahi_unescape_label(&name, label, sizeof(label)))) |
207 | 0 | goto fail; |
208 | | |
209 | 14.0k | if (!(d = avahi_dns_packet_append_string(p, label))) |
210 | 80 | goto fail; |
211 | | |
212 | 13.9k | if (!p->name_table) |
213 | | /* This works only for normalized domain names */ |
214 | 1.20k | if (!(p->name_table = avahi_hashmap_new(avahi_string_hash, avahi_string_equal, avahi_free, NULL))) |
215 | 0 | goto fail; |
216 | | |
217 | 13.9k | if (!(u = avahi_strdup(pname))) |
218 | 0 | goto fail; |
219 | | |
220 | 13.9k | if (avahi_hashmap_insert(p->name_table, u, d) < 0) { |
221 | 0 | avahi_free(u); |
222 | 0 | goto fail; |
223 | 0 | } |
224 | 13.9k | } |
225 | | |
226 | 2.47k | if (!(d = avahi_dns_packet_extend(p, 1))) |
227 | 22 | goto fail; |
228 | | |
229 | 2.45k | *d = 0; |
230 | | |
231 | 2.45k | return saved_ptr; |
232 | | |
233 | 102 | fail: |
234 | 102 | p->size = saved_size; |
235 | 102 | avahi_dns_packet_cleanup_name_table(p); |
236 | | |
237 | 102 | return NULL; |
238 | 2.47k | } |
239 | | |
240 | 5.42k | uint8_t* avahi_dns_packet_append_uint16(AvahiDnsPacket *p, uint16_t v) { |
241 | 5.42k | uint8_t *d; |
242 | 5.42k | assert(p); |
243 | | |
244 | 5.42k | if (!(d = avahi_dns_packet_extend(p, sizeof(uint16_t)))) |
245 | 11 | return NULL; |
246 | | |
247 | 5.40k | d[0] = (uint8_t) (v >> 8); |
248 | 5.40k | d[1] = (uint8_t) v; |
249 | 5.40k | return d; |
250 | 5.42k | } |
251 | | |
252 | 1.49k | uint8_t *avahi_dns_packet_append_uint32(AvahiDnsPacket *p, uint32_t v) { |
253 | 1.49k | uint8_t *d; |
254 | 1.49k | assert(p); |
255 | | |
256 | 1.49k | if (!(d = avahi_dns_packet_extend(p, sizeof(uint32_t)))) |
257 | 2 | return NULL; |
258 | | |
259 | 1.49k | d[0] = (uint8_t) (v >> 24); |
260 | 1.49k | d[1] = (uint8_t) (v >> 16); |
261 | 1.49k | d[2] = (uint8_t) (v >> 8); |
262 | 1.49k | d[3] = (uint8_t) v; |
263 | | |
264 | 1.49k | return d; |
265 | 1.49k | } |
266 | | |
267 | 778 | uint8_t *avahi_dns_packet_append_bytes(AvahiDnsPacket *p, const void *b, size_t l) { |
268 | 778 | uint8_t* d; |
269 | | |
270 | 778 | assert(p); |
271 | 778 | assert(b); |
272 | 778 | assert(l); |
273 | | |
274 | 778 | if (!(d = avahi_dns_packet_extend(p, l))) |
275 | 10 | return NULL; |
276 | | |
277 | 768 | memcpy(d, b, l); |
278 | 768 | return d; |
279 | 778 | } |
280 | | |
281 | 15.5k | uint8_t* avahi_dns_packet_append_string(AvahiDnsPacket *p, const char *s) { |
282 | 15.5k | uint8_t* d; |
283 | 15.5k | size_t k; |
284 | | |
285 | 15.5k | assert(p); |
286 | 15.5k | assert(s); |
287 | | |
288 | 15.5k | if ((k = strlen(s)) >= 255) |
289 | 121 | k = 255; |
290 | | |
291 | 15.5k | if (!(d = avahi_dns_packet_extend(p, k+1))) |
292 | 89 | return NULL; |
293 | | |
294 | 15.5k | *d = (uint8_t) k; |
295 | 15.5k | memcpy(d+1, s, k); |
296 | | |
297 | 15.5k | return d; |
298 | 15.5k | } |
299 | | |
300 | 31.9k | uint8_t *avahi_dns_packet_extend(AvahiDnsPacket *p, size_t l) { |
301 | 31.9k | uint8_t *d; |
302 | | |
303 | 31.9k | assert(p); |
304 | | |
305 | 31.9k | if (p->size+l > p->max_size) |
306 | 149 | return NULL; |
307 | | |
308 | 31.7k | d = AVAHI_DNS_PACKET_DATA(p) + p->size; |
309 | 31.7k | p->size += l; |
310 | | |
311 | 31.7k | return d; |
312 | 31.9k | } |
313 | | |
314 | 0 | int avahi_dns_packet_check_valid(AvahiDnsPacket *p) { |
315 | 0 | uint16_t flags; |
316 | 0 | assert(p); |
317 | | |
318 | 0 | if (p->size < AVAHI_DNS_PACKET_HEADER_SIZE) |
319 | 0 | return -1; |
320 | | |
321 | 0 | flags = avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_FLAGS); |
322 | |
|
323 | 0 | if (flags & AVAHI_DNS_FLAG_OPCODE) |
324 | 0 | return -1; |
325 | | |
326 | 0 | return 0; |
327 | 0 | } |
328 | | |
329 | 0 | int avahi_dns_packet_check_valid_multicast(AvahiDnsPacket *p) { |
330 | 0 | uint16_t flags; |
331 | 0 | assert(p); |
332 | | |
333 | 0 | if (avahi_dns_packet_check_valid(p) < 0) |
334 | 0 | return -1; |
335 | | |
336 | 0 | flags = avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_FLAGS); |
337 | |
|
338 | 0 | if (flags & AVAHI_DNS_FLAG_RCODE) |
339 | 0 | return -1; |
340 | | |
341 | 0 | return 0; |
342 | 0 | } |
343 | | |
344 | 0 | int avahi_dns_packet_is_query(AvahiDnsPacket *p) { |
345 | 0 | assert(p); |
346 | | |
347 | 0 | return !(avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_FLAGS) & AVAHI_DNS_FLAG_QR); |
348 | 0 | } |
349 | | |
350 | 8.78k | static int consume_labels(AvahiDnsPacket *p, unsigned idx, char *ret_name, size_t l) { |
351 | 8.78k | int ret = 0; |
352 | 8.78k | int compressed = 0; |
353 | 8.78k | int first_label = 1; |
354 | 8.78k | unsigned label_ptr; |
355 | 8.78k | int i; |
356 | 8.78k | assert(p && ret_name && l); |
357 | | |
358 | 63.0k | for (i = 0; i < AVAHI_DNS_LABELS_MAX; i++) { |
359 | 62.9k | uint8_t n; |
360 | | |
361 | 62.9k | if (idx+1 > p->size) |
362 | 1.13k | return -1; |
363 | | |
364 | 61.8k | n = AVAHI_DNS_PACKET_DATA(p)[idx]; |
365 | | |
366 | 61.8k | if (!n) { |
367 | 7.19k | idx++; |
368 | 7.19k | if (!compressed) |
369 | 5.95k | ret++; |
370 | | |
371 | 7.19k | if (l < 1) |
372 | 0 | return -1; |
373 | 7.19k | *ret_name = 0; |
374 | | |
375 | 7.19k | return ret; |
376 | | |
377 | 54.6k | } else if (n <= 63) { |
378 | | /* Uncompressed label */ |
379 | 46.6k | idx++; |
380 | 46.6k | if (!compressed) |
381 | 31.9k | ret++; |
382 | | |
383 | 46.6k | if (idx + n > p->size) |
384 | 72 | return -1; |
385 | | |
386 | 46.5k | if ((size_t) n + 1 > l) |
387 | 30 | return -1; |
388 | | |
389 | 46.5k | if (!first_label) { |
390 | 42.6k | *(ret_name++) = '.'; |
391 | 42.6k | l--; |
392 | 42.6k | } else |
393 | 3.86k | first_label = 0; |
394 | | |
395 | 46.5k | if (!(avahi_escape_label((char*) AVAHI_DNS_PACKET_DATA(p) + idx, n, &ret_name, &l))) |
396 | 28 | return -1; |
397 | | |
398 | 46.5k | idx += n; |
399 | | |
400 | 46.5k | if (!compressed) |
401 | 31.8k | ret += n; |
402 | 46.5k | } else if ((n & 0xC0) == 0xC0) { |
403 | | /* Compressed label */ |
404 | | |
405 | 7.96k | if (idx+2 > p->size) |
406 | 22 | return -1; |
407 | | |
408 | 7.94k | label_ptr = ((unsigned) (AVAHI_DNS_PACKET_DATA(p)[idx] & ~0xC0)) << 8 | AVAHI_DNS_PACKET_DATA(p)[idx+1]; |
409 | | |
410 | 7.94k | if ((label_ptr < AVAHI_DNS_PACKET_HEADER_SIZE) || (label_ptr >= idx)) |
411 | 153 | return -1; |
412 | | |
413 | 7.78k | idx = label_ptr; |
414 | | |
415 | 7.78k | if (!compressed) |
416 | 1.40k | ret += 2; |
417 | | |
418 | 7.78k | compressed = 1; |
419 | 7.78k | } else |
420 | 48 | return -1; |
421 | 61.8k | } |
422 | | |
423 | 97 | return -1; |
424 | 8.78k | } |
425 | | |
426 | 8.78k | int avahi_dns_packet_consume_name(AvahiDnsPacket *p, char *ret_name, size_t l) { |
427 | 8.78k | int r; |
428 | | |
429 | 8.78k | if ((r = consume_labels(p, p->rindex, ret_name, l)) < 0) |
430 | 1.58k | return -1; |
431 | | |
432 | 7.19k | p->rindex += r; |
433 | 7.19k | return 0; |
434 | 8.78k | } |
435 | | |
436 | 16.3k | int avahi_dns_packet_consume_uint16(AvahiDnsPacket *p, uint16_t *ret_v) { |
437 | 16.3k | uint8_t *d; |
438 | | |
439 | 16.3k | assert(p); |
440 | 16.3k | assert(ret_v); |
441 | | |
442 | 16.3k | if (p->rindex + sizeof(uint16_t) > p->size) |
443 | 142 | return -1; |
444 | | |
445 | 16.1k | d = (uint8_t*) (AVAHI_DNS_PACKET_DATA(p) + p->rindex); |
446 | 16.1k | *ret_v = (d[0] << 8) | d[1]; |
447 | 16.1k | p->rindex += sizeof(uint16_t); |
448 | | |
449 | 16.1k | return 0; |
450 | 16.3k | } |
451 | | |
452 | 4.24k | int avahi_dns_packet_consume_uint32(AvahiDnsPacket *p, uint32_t *ret_v) { |
453 | 4.24k | uint8_t* d; |
454 | | |
455 | 4.24k | assert(p); |
456 | 4.24k | assert(ret_v); |
457 | | |
458 | 4.24k | if (p->rindex + sizeof(uint32_t) > p->size) |
459 | 22 | return -1; |
460 | | |
461 | 4.21k | d = (uint8_t*) (AVAHI_DNS_PACKET_DATA(p) + p->rindex); |
462 | 4.21k | *ret_v = ((uint32_t)d[0] << 24) | ((uint32_t)d[1] << 16) | ((uint32_t)d[2] << 8) | (uint32_t)d[3]; |
463 | 4.21k | p->rindex += sizeof(uint32_t); |
464 | | |
465 | 4.21k | return 0; |
466 | 4.24k | } |
467 | | |
468 | 227 | int avahi_dns_packet_consume_bytes(AvahiDnsPacket *p, void * ret_data, size_t l) { |
469 | 227 | assert(p); |
470 | 227 | assert(ret_data); |
471 | 227 | assert(l > 0); |
472 | | |
473 | 227 | if (p->rindex + l > p->size) |
474 | 16 | return -1; |
475 | | |
476 | 211 | memcpy(ret_data, AVAHI_DNS_PACKET_DATA(p) + p->rindex, l); |
477 | 211 | p->rindex += l; |
478 | | |
479 | 211 | return 0; |
480 | 227 | } |
481 | | |
482 | 2.48k | int avahi_dns_packet_consume_string(AvahiDnsPacket *p, char *ret_string, size_t l) { |
483 | 2.48k | size_t k; |
484 | | |
485 | 2.48k | assert(p); |
486 | 2.48k | assert(ret_string); |
487 | 2.48k | assert(l > 0); |
488 | | |
489 | 2.48k | if (p->rindex >= p->size) |
490 | 7 | return -1; |
491 | | |
492 | 2.47k | k = AVAHI_DNS_PACKET_DATA(p)[p->rindex]; |
493 | | |
494 | 2.47k | if (p->rindex+1+k > p->size) |
495 | 45 | return -1; |
496 | | |
497 | 2.42k | if (l > k+1) |
498 | 2.42k | l = k+1; |
499 | | |
500 | 2.42k | memcpy(ret_string, AVAHI_DNS_PACKET_DATA(p)+p->rindex+1, l-1); |
501 | 2.42k | ret_string[l-1] = 0; |
502 | | |
503 | 2.42k | p->rindex += 1+k; |
504 | | |
505 | 2.42k | return 0; |
506 | 2.47k | } |
507 | | |
508 | 14.8k | const void* avahi_dns_packet_get_rptr(AvahiDnsPacket *p) { |
509 | 14.8k | assert(p); |
510 | | |
511 | 14.8k | if (p->rindex > p->size) |
512 | 0 | return NULL; |
513 | | |
514 | 14.8k | return AVAHI_DNS_PACKET_DATA(p) + p->rindex; |
515 | 14.8k | } |
516 | | |
517 | 1.94k | int avahi_dns_packet_skip(AvahiDnsPacket *p, size_t length) { |
518 | 1.94k | assert(p); |
519 | | |
520 | 1.94k | if (p->rindex + length > p->size) |
521 | 0 | return -1; |
522 | | |
523 | 1.94k | p->rindex += length; |
524 | 1.94k | return 0; |
525 | 1.94k | } |
526 | | |
527 | 6.50k | static int parse_rdata(AvahiDnsPacket *p, AvahiRecord *r, uint16_t rdlength) { |
528 | 6.50k | char buf[AVAHI_DOMAIN_NAME_MAX]; |
529 | 6.50k | const void* start; |
530 | | |
531 | 6.50k | assert(p); |
532 | 6.50k | assert(r); |
533 | | |
534 | 6.50k | start = avahi_dns_packet_get_rptr(p); |
535 | | |
536 | 6.50k | switch (r->key->type) { |
537 | 277 | case AVAHI_DNS_TYPE_PTR: |
538 | 1.01k | case AVAHI_DNS_TYPE_CNAME: |
539 | 1.39k | case AVAHI_DNS_TYPE_NS: |
540 | | |
541 | 1.39k | if (avahi_dns_packet_consume_name(p, buf, sizeof(buf)) < 0) |
542 | 10 | return -1; |
543 | | |
544 | 1.38k | if (!(r->data.ptr.name = avahi_strdup(buf))) |
545 | 0 | return -1; |
546 | | |
547 | 1.38k | break; |
548 | | |
549 | | |
550 | 1.38k | case AVAHI_DNS_TYPE_SRV: |
551 | | |
552 | 475 | if (avahi_dns_packet_consume_uint16(p, &r->data.srv.priority) < 0 || |
553 | 467 | avahi_dns_packet_consume_uint16(p, &r->data.srv.weight) < 0 || |
554 | 457 | avahi_dns_packet_consume_uint16(p, &r->data.srv.port) < 0 || |
555 | 447 | avahi_dns_packet_consume_name(p, buf, sizeof(buf)) < 0) |
556 | 51 | return -1; |
557 | | |
558 | 424 | if (!(r->data.srv.name = avahi_strdup(buf))) |
559 | 0 | return -1; |
560 | | |
561 | 424 | break; |
562 | | |
563 | 1.25k | case AVAHI_DNS_TYPE_HINFO: |
564 | | |
565 | 1.25k | if (avahi_dns_packet_consume_string(p, buf, sizeof(buf)) < 0) |
566 | 30 | return -1; |
567 | | |
568 | 1.22k | if (!(r->data.hinfo.cpu = avahi_strdup(buf))) |
569 | 0 | return -1; |
570 | | |
571 | 1.22k | if (avahi_dns_packet_consume_string(p, buf, sizeof(buf)) < 0) |
572 | 22 | return -1; |
573 | | |
574 | 1.20k | if (!(r->data.hinfo.os = avahi_strdup(buf))) |
575 | 0 | return -1; |
576 | | |
577 | 1.20k | break; |
578 | | |
579 | 1.20k | case AVAHI_DNS_TYPE_TXT: |
580 | | |
581 | 984 | if (rdlength > 0) { |
582 | 947 | if (avahi_string_list_parse(avahi_dns_packet_get_rptr(p), rdlength, &r->data.txt.string_list) < 0) |
583 | 35 | return -1; |
584 | | |
585 | 912 | if (avahi_dns_packet_skip(p, rdlength) < 0) |
586 | 0 | return -1; |
587 | 912 | } else |
588 | 37 | r->data.txt.string_list = NULL; |
589 | | |
590 | 949 | break; |
591 | | |
592 | 949 | case AVAHI_DNS_TYPE_A: |
593 | | |
594 | | /* avahi_log_debug("A"); */ |
595 | | |
596 | 135 | if (avahi_dns_packet_consume_bytes(p, &r->data.a.address, sizeof(AvahiIPv4Address)) < 0) |
597 | 8 | return -1; |
598 | | |
599 | 127 | break; |
600 | | |
601 | 127 | case AVAHI_DNS_TYPE_AAAA: |
602 | | |
603 | | /* avahi_log_debug("aaaa"); */ |
604 | | |
605 | 92 | if (avahi_dns_packet_consume_bytes(p, &r->data.aaaa.address, sizeof(AvahiIPv6Address)) < 0) |
606 | 8 | return -1; |
607 | | |
608 | 84 | break; |
609 | | |
610 | 2.16k | default: |
611 | | |
612 | | /* avahi_log_debug("generic"); */ |
613 | | |
614 | 2.16k | if (rdlength > 0) { |
615 | | |
616 | 1.02k | if (!(r->data.generic.data = avahi_memdup(avahi_dns_packet_get_rptr(p), rdlength))) |
617 | 0 | return -1; |
618 | | |
619 | 1.02k | r->data.generic.size = rdlength; |
620 | | |
621 | 1.02k | if (avahi_dns_packet_skip(p, rdlength) < 0) |
622 | 0 | return -1; |
623 | 1.02k | } |
624 | | |
625 | 2.16k | break; |
626 | 6.50k | } |
627 | | |
628 | | /* Check if we read enough data */ |
629 | 6.34k | if ((const uint8_t*) avahi_dns_packet_get_rptr(p) - (const uint8_t*) start != rdlength) |
630 | 45 | return -1; |
631 | | |
632 | 6.29k | return 0; |
633 | 6.34k | } |
634 | | |
635 | 5.28k | AvahiRecord* avahi_dns_packet_consume_record(AvahiDnsPacket *p, int *ret_cache_flush) { |
636 | 5.28k | char name[AVAHI_DOMAIN_NAME_MAX]; |
637 | 5.28k | uint16_t type, class; |
638 | 5.28k | uint32_t ttl; |
639 | 5.28k | uint16_t rdlength; |
640 | 5.28k | AvahiRecord *r = NULL; |
641 | | |
642 | 5.28k | assert(p); |
643 | | |
644 | 5.28k | if (avahi_dns_packet_consume_name(p, name, sizeof(name)) < 0 || |
645 | 4.30k | avahi_dns_packet_consume_uint16(p, &type) < 0 || |
646 | 4.25k | avahi_dns_packet_consume_uint16(p, &class) < 0 || |
647 | 4.24k | avahi_dns_packet_consume_uint32(p, &ttl) < 0 || |
648 | 4.21k | avahi_dns_packet_consume_uint16(p, &rdlength) < 0 || |
649 | 4.20k | p->rindex + rdlength > p->size) |
650 | 1.11k | goto fail; |
651 | | |
652 | 4.17k | if (ret_cache_flush) |
653 | 0 | *ret_cache_flush = !!(class & AVAHI_DNS_CACHE_FLUSH); |
654 | 4.17k | class &= ~AVAHI_DNS_CACHE_FLUSH; |
655 | | |
656 | 4.17k | if (!(r = avahi_record_new_full(name, class, type, ttl))) |
657 | 16 | goto fail; |
658 | | |
659 | 4.15k | if (parse_rdata(p, r, rdlength) < 0) |
660 | 209 | goto fail; |
661 | | |
662 | 3.94k | if (!avahi_record_is_valid(r)) |
663 | 96 | goto fail; |
664 | | |
665 | 3.85k | return r; |
666 | | |
667 | 1.43k | fail: |
668 | 1.43k | if (r) |
669 | 305 | avahi_record_unref(r); |
670 | | |
671 | 1.43k | return NULL; |
672 | 3.94k | } |
673 | | |
674 | 1.65k | AvahiKey* avahi_dns_packet_consume_key(AvahiDnsPacket *p, int *ret_unicast_response) { |
675 | 1.65k | char name[AVAHI_DOMAIN_NAME_MAX]; |
676 | 1.65k | uint16_t type, class; |
677 | 1.65k | AvahiKey *k; |
678 | | |
679 | 1.65k | assert(p); |
680 | | |
681 | 1.65k | if (avahi_dns_packet_consume_name(p, name, sizeof(name)) < 0 || |
682 | 1.07k | avahi_dns_packet_consume_uint16(p, &type) < 0 || |
683 | 1.05k | avahi_dns_packet_consume_uint16(p, &class) < 0) |
684 | 609 | return NULL; |
685 | | |
686 | 1.04k | if (ret_unicast_response) |
687 | 0 | *ret_unicast_response = !!(class & AVAHI_DNS_UNICAST_RESPONSE); |
688 | | |
689 | 1.04k | class &= ~AVAHI_DNS_UNICAST_RESPONSE; |
690 | | |
691 | 1.04k | if (!(k = avahi_key_new(name, class, type))) |
692 | 113 | return NULL; |
693 | | |
694 | 930 | if (!avahi_key_is_valid(k)) { |
695 | 0 | avahi_key_unref(k); |
696 | 0 | return NULL; |
697 | 0 | } |
698 | | |
699 | 930 | return k; |
700 | 930 | } |
701 | | |
702 | 0 | uint8_t* avahi_dns_packet_append_key(AvahiDnsPacket *p, AvahiKey *k, int unicast_response) { |
703 | 0 | uint8_t *t; |
704 | 0 | size_t size; |
705 | |
|
706 | 0 | assert(p); |
707 | 0 | assert(k); |
708 | | |
709 | 0 | size = p->size; |
710 | |
|
711 | 0 | if (!(t = avahi_dns_packet_append_name(p, k->name)) || |
712 | 0 | !avahi_dns_packet_append_uint16(p, k->type) || |
713 | 0 | !avahi_dns_packet_append_uint16(p, k->clazz | (unicast_response ? AVAHI_DNS_UNICAST_RESPONSE : 0))) { |
714 | 0 | p->size = size; |
715 | 0 | avahi_dns_packet_cleanup_name_table(p); |
716 | |
|
717 | 0 | return NULL; |
718 | 0 | } |
719 | | |
720 | 0 | return t; |
721 | 0 | } |
722 | | |
723 | 3.84k | static int append_rdata(AvahiDnsPacket *p, AvahiRecord *r) { |
724 | 3.84k | assert(p); |
725 | 3.84k | assert(r); |
726 | | |
727 | 3.84k | switch (r->key->type) { |
728 | | |
729 | 149 | case AVAHI_DNS_TYPE_PTR: |
730 | 641 | case AVAHI_DNS_TYPE_CNAME: |
731 | 834 | case AVAHI_DNS_TYPE_NS: |
732 | | |
733 | 834 | if (!(avahi_dns_packet_append_name(p, r->data.ptr.name))) |
734 | 95 | return -1; |
735 | | |
736 | 739 | break; |
737 | | |
738 | 739 | case AVAHI_DNS_TYPE_SRV: |
739 | | |
740 | 314 | if (!avahi_dns_packet_append_uint16(p, r->data.srv.priority) || |
741 | 312 | !avahi_dns_packet_append_uint16(p, r->data.srv.weight) || |
742 | 310 | !avahi_dns_packet_append_uint16(p, r->data.srv.port) || |
743 | 308 | !avahi_dns_packet_append_name(p, r->data.srv.name)) |
744 | 21 | return -1; |
745 | | |
746 | 293 | break; |
747 | | |
748 | 774 | case AVAHI_DNS_TYPE_HINFO: |
749 | 774 | if (!avahi_dns_packet_append_string(p, r->data.hinfo.cpu) || |
750 | 770 | !avahi_dns_packet_append_string(p, r->data.hinfo.os)) |
751 | 9 | return -1; |
752 | | |
753 | 765 | break; |
754 | | |
755 | 765 | case AVAHI_DNS_TYPE_TXT: { |
756 | | |
757 | 566 | uint8_t *data; |
758 | 566 | size_t n; |
759 | | |
760 | 566 | n = avahi_string_list_serialize(r->data.txt.string_list, NULL, 0); |
761 | | |
762 | 566 | if (!(data = avahi_dns_packet_extend(p, n))) |
763 | 4 | return -1; |
764 | | |
765 | 562 | avahi_string_list_serialize(r->data.txt.string_list, data, n); |
766 | 562 | break; |
767 | 566 | } |
768 | | |
769 | | |
770 | 89 | case AVAHI_DNS_TYPE_A: |
771 | | |
772 | 89 | if (!avahi_dns_packet_append_bytes(p, &r->data.a.address, sizeof(r->data.a.address))) |
773 | 2 | return -1; |
774 | | |
775 | 87 | break; |
776 | | |
777 | 87 | case AVAHI_DNS_TYPE_AAAA: |
778 | | |
779 | 50 | if (!avahi_dns_packet_append_bytes(p, &r->data.aaaa.address, sizeof(r->data.aaaa.address))) |
780 | 1 | return -1; |
781 | | |
782 | 49 | break; |
783 | | |
784 | 1.21k | default: |
785 | | |
786 | 1.21k | if (r->data.generic.size) |
787 | 639 | if (!avahi_dns_packet_append_bytes(p, r->data.generic.data, r->data.generic.size)) |
788 | 7 | return -1; |
789 | | |
790 | 1.20k | break; |
791 | 3.84k | } |
792 | | |
793 | 3.70k | return 0; |
794 | 3.84k | } |
795 | | |
796 | | |
797 | 1.50k | uint8_t* avahi_dns_packet_append_record(AvahiDnsPacket *p, AvahiRecord *r, int cache_flush, unsigned max_ttl) { |
798 | 1.50k | uint8_t *t, *l, *start; |
799 | 1.50k | size_t size; |
800 | | |
801 | 1.50k | assert(p); |
802 | 1.50k | assert(r); |
803 | | |
804 | 1.50k | size = p->size; |
805 | | |
806 | 1.50k | if (!(t = avahi_dns_packet_append_name(p, r->key->name)) || |
807 | 1.49k | !avahi_dns_packet_append_uint16(p, r->key->type) || |
808 | 1.49k | !avahi_dns_packet_append_uint16(p, cache_flush ? (r->key->clazz | AVAHI_DNS_CACHE_FLUSH) : (r->key->clazz &~ AVAHI_DNS_CACHE_FLUSH)) || |
809 | 1.49k | !avahi_dns_packet_append_uint32(p, (max_ttl && r->ttl > max_ttl) ? max_ttl : r->ttl) || |
810 | 1.49k | !(l = avahi_dns_packet_append_uint16(p, 0))) |
811 | 10 | goto fail; |
812 | | |
813 | 1.49k | start = avahi_dns_packet_extend(p, 0); |
814 | | |
815 | 1.49k | if (append_rdata(p, r) < 0) |
816 | 139 | goto fail; |
817 | | |
818 | 1.35k | size = avahi_dns_packet_extend(p, 0) - start; |
819 | 1.35k | assert(size <= AVAHI_DNS_RDATA_MAX); |
820 | | |
821 | | /* avahi_log_debug("appended %u", size); */ |
822 | | |
823 | 1.35k | l[0] = (uint8_t) ((uint16_t) size >> 8); |
824 | 1.35k | l[1] = (uint8_t) ((uint16_t) size); |
825 | | |
826 | 1.35k | return t; |
827 | | |
828 | | |
829 | 149 | fail: |
830 | 149 | p->size = size; |
831 | 149 | avahi_dns_packet_cleanup_name_table(p); |
832 | | |
833 | 149 | return NULL; |
834 | 1.35k | } |
835 | | |
836 | 0 | int avahi_dns_packet_is_empty(AvahiDnsPacket *p) { |
837 | 0 | assert(p); |
838 | | |
839 | 0 | return p->size <= AVAHI_DNS_PACKET_HEADER_SIZE; |
840 | 0 | } |
841 | | |
842 | 0 | size_t avahi_dns_packet_space(AvahiDnsPacket *p) { |
843 | 0 | assert(p); |
844 | | |
845 | 0 | assert(p->size <= p->max_size); |
846 | | |
847 | 0 | return p->max_size - p->size; |
848 | 0 | } |
849 | | |
850 | 0 | size_t avahi_dns_packet_reserve_size(AvahiDnsPacket *p, size_t res_size) { |
851 | 0 | assert(p); |
852 | | |
853 | 0 | assert(p->size + p->res_size <= p->max_size); |
854 | | |
855 | 0 | if ((p->size + p->res_size + res_size) <= p->max_size) |
856 | 0 | p->res_size += res_size; |
857 | |
|
858 | 0 | return p->res_size; |
859 | 0 | } |
860 | | |
861 | 0 | size_t avahi_dns_packet_reserved_space(AvahiDnsPacket *p) { |
862 | 0 | assert(p); |
863 | | |
864 | 0 | assert(p->size + p->res_size <= p->max_size); |
865 | | |
866 | 0 | return p->max_size - p->size - p->res_size; |
867 | 0 | } |
868 | | |
869 | 2.35k | int avahi_rdata_parse(AvahiRecord *record, const void* rdata, size_t size) { |
870 | 2.35k | int ret; |
871 | 2.35k | AvahiDnsPacket p; |
872 | | |
873 | 2.35k | assert(record); |
874 | 2.35k | assert(rdata); |
875 | | |
876 | | /* rdlength is a 16 bit field on the wire and parse_rdata() takes it |
877 | | * as a uint16_t, so anything bigger would be silently truncated and |
878 | | * parsed as an unrelated length. Reject it instead. */ |
879 | 2.35k | if (size > AVAHI_DNS_RDATA_MAX) |
880 | 0 | return -1; |
881 | | |
882 | 2.35k | p.data = (void*) rdata; |
883 | 2.35k | p.max_size = p.size = size; |
884 | 2.35k | p.rindex = 0; |
885 | 2.35k | p.name_table = NULL; |
886 | | |
887 | 2.35k | ret = parse_rdata(&p, record, size); |
888 | | |
889 | 2.35k | assert(!p.name_table); |
890 | | |
891 | 2.35k | return ret; |
892 | 2.35k | } |
893 | | |
894 | 2.35k | size_t avahi_rdata_serialize(AvahiRecord *record, void *rdata, size_t max_size) { |
895 | 2.35k | int ret; |
896 | 2.35k | AvahiDnsPacket p; |
897 | | |
898 | 2.35k | assert(record); |
899 | 2.35k | assert(rdata); |
900 | 2.35k | assert(max_size > 0); |
901 | | |
902 | 2.35k | p.data = (void*) rdata; |
903 | 2.35k | p.max_size = max_size; |
904 | 2.35k | p.size = p.rindex = 0; |
905 | 2.35k | p.name_table = NULL; |
906 | | |
907 | 2.35k | ret = append_rdata(&p, record); |
908 | | |
909 | 2.35k | if (p.name_table) |
910 | 601 | avahi_hashmap_free(p.name_table); |
911 | | |
912 | 2.35k | if (ret < 0) |
913 | 0 | return (size_t) -1; |
914 | | |
915 | 2.35k | return p.size; |
916 | 2.35k | } |