/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 | 0 | AvahiDnsPacket* avahi_dns_packet_new(unsigned mtu) { |
40 | 0 | AvahiDnsPacket *p; |
41 | 0 | size_t max_size; |
42 | |
|
43 | 0 | if (mtu <= 0) |
44 | 0 | max_size = AVAHI_DNS_PACKET_SIZE_MAX; |
45 | 0 | else if (mtu >= AVAHI_DNS_PACKET_EXTRA_SIZE) |
46 | 0 | max_size = mtu - AVAHI_DNS_PACKET_EXTRA_SIZE; |
47 | 0 | else |
48 | 0 | max_size = 0; |
49 | |
|
50 | 0 | if (max_size < AVAHI_DNS_PACKET_HEADER_SIZE) |
51 | 0 | max_size = AVAHI_DNS_PACKET_HEADER_SIZE; |
52 | |
|
53 | 0 | if (!(p = avahi_malloc(sizeof(AvahiDnsPacket) + max_size))) |
54 | 0 | return p; |
55 | | |
56 | 0 | p->size = p->rindex = AVAHI_DNS_PACKET_HEADER_SIZE; |
57 | 0 | p->max_size = max_size; |
58 | 0 | p->res_size = 0; |
59 | 0 | p->name_table = NULL; |
60 | 0 | p->data = NULL; |
61 | |
|
62 | 0 | memset(AVAHI_DNS_PACKET_DATA(p), 0, p->size); |
63 | 0 | return p; |
64 | 0 | } |
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 | 0 | void avahi_dns_packet_free(AvahiDnsPacket *p) { |
126 | 0 | assert(p); |
127 | | |
128 | 0 | if (p->name_table) |
129 | 0 | avahi_hashmap_free(p->name_table); |
130 | |
|
131 | 0 | avahi_free(p); |
132 | 0 | } |
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 | 0 | static void name_table_cleanup(void *key, void *value, void *user_data) { |
157 | 0 | AvahiDnsPacket *p = user_data; |
158 | |
|
159 | 0 | if ((uint8_t*) value >= AVAHI_DNS_PACKET_DATA(p) + p->size) |
160 | 0 | avahi_hashmap_remove(p->name_table, key); |
161 | 0 | } |
162 | | |
163 | 0 | void avahi_dns_packet_cleanup_name_table(AvahiDnsPacket *p) { |
164 | 0 | if (p->name_table) |
165 | 0 | avahi_hashmap_foreach(p->name_table, name_table_cleanup, p); |
166 | 0 | } |
167 | | |
168 | 0 | uint8_t* avahi_dns_packet_append_name(AvahiDnsPacket *p, const char *name) { |
169 | 0 | uint8_t *d, *saved_ptr = NULL; |
170 | 0 | size_t saved_size; |
171 | |
|
172 | 0 | assert(p); |
173 | 0 | assert(name); |
174 | | |
175 | 0 | saved_size = p->size; |
176 | 0 | saved_ptr = avahi_dns_packet_extend(p, 0); |
177 | |
|
178 | 0 | while (*name) { |
179 | 0 | uint8_t* prev; |
180 | 0 | const char *pname; |
181 | 0 | char label[64], *u; |
182 | | |
183 | | /* Check whether we can compress this name. */ |
184 | |
|
185 | 0 | if (p->name_table && (prev = avahi_hashmap_lookup(p->name_table, name))) { |
186 | 0 | unsigned idx; |
187 | |
|
188 | 0 | assert(prev >= AVAHI_DNS_PACKET_DATA(p)); |
189 | 0 | idx = (unsigned) (prev - AVAHI_DNS_PACKET_DATA(p)); |
190 | |
|
191 | 0 | assert(idx < p->size); |
192 | | |
193 | 0 | if (idx < 0x4000) { |
194 | 0 | uint8_t *t; |
195 | 0 | if (!(t = (uint8_t*) avahi_dns_packet_extend(p, sizeof(uint16_t)))) |
196 | 0 | return NULL; |
197 | | |
198 | 0 | t[0] = (uint8_t) ((0xC000 | idx) >> 8); |
199 | 0 | t[1] = (uint8_t) idx; |
200 | 0 | return saved_ptr; |
201 | 0 | } |
202 | 0 | } |
203 | | |
204 | 0 | pname = name; |
205 | |
|
206 | 0 | if (!(avahi_unescape_label(&name, label, sizeof(label)))) |
207 | 0 | goto fail; |
208 | | |
209 | 0 | if (!(d = avahi_dns_packet_append_string(p, label))) |
210 | 0 | goto fail; |
211 | | |
212 | 0 | if (!p->name_table) |
213 | | /* This works only for normalized domain names */ |
214 | 0 | if (!(p->name_table = avahi_hashmap_new(avahi_string_hash, avahi_string_equal, avahi_free, NULL))) |
215 | 0 | goto fail; |
216 | | |
217 | 0 | if (!(u = avahi_strdup(pname))) |
218 | 0 | goto fail; |
219 | | |
220 | 0 | if (avahi_hashmap_insert(p->name_table, u, d) < 0) { |
221 | 0 | avahi_free(u); |
222 | 0 | goto fail; |
223 | 0 | } |
224 | 0 | } |
225 | | |
226 | 0 | if (!(d = avahi_dns_packet_extend(p, 1))) |
227 | 0 | goto fail; |
228 | | |
229 | 0 | *d = 0; |
230 | |
|
231 | 0 | return saved_ptr; |
232 | | |
233 | 0 | fail: |
234 | 0 | p->size = saved_size; |
235 | 0 | avahi_dns_packet_cleanup_name_table(p); |
236 | |
|
237 | 0 | return NULL; |
238 | 0 | } |
239 | | |
240 | 0 | uint8_t* avahi_dns_packet_append_uint16(AvahiDnsPacket *p, uint16_t v) { |
241 | 0 | uint8_t *d; |
242 | 0 | assert(p); |
243 | | |
244 | 0 | if (!(d = avahi_dns_packet_extend(p, sizeof(uint16_t)))) |
245 | 0 | return NULL; |
246 | | |
247 | 0 | d[0] = (uint8_t) (v >> 8); |
248 | 0 | d[1] = (uint8_t) v; |
249 | 0 | return d; |
250 | 0 | } |
251 | | |
252 | 0 | uint8_t *avahi_dns_packet_append_uint32(AvahiDnsPacket *p, uint32_t v) { |
253 | 0 | uint8_t *d; |
254 | 0 | assert(p); |
255 | | |
256 | 0 | if (!(d = avahi_dns_packet_extend(p, sizeof(uint32_t)))) |
257 | 0 | return NULL; |
258 | | |
259 | 0 | d[0] = (uint8_t) (v >> 24); |
260 | 0 | d[1] = (uint8_t) (v >> 16); |
261 | 0 | d[2] = (uint8_t) (v >> 8); |
262 | 0 | d[3] = (uint8_t) v; |
263 | |
|
264 | 0 | return d; |
265 | 0 | } |
266 | | |
267 | 0 | uint8_t *avahi_dns_packet_append_bytes(AvahiDnsPacket *p, const void *b, size_t l) { |
268 | 0 | uint8_t* d; |
269 | |
|
270 | 0 | assert(p); |
271 | 0 | assert(b); |
272 | 0 | assert(l); |
273 | | |
274 | 0 | if (!(d = avahi_dns_packet_extend(p, l))) |
275 | 0 | return NULL; |
276 | | |
277 | 0 | memcpy(d, b, l); |
278 | 0 | return d; |
279 | 0 | } |
280 | | |
281 | 0 | uint8_t* avahi_dns_packet_append_string(AvahiDnsPacket *p, const char *s) { |
282 | 0 | uint8_t* d; |
283 | 0 | size_t k; |
284 | |
|
285 | 0 | assert(p); |
286 | 0 | assert(s); |
287 | | |
288 | 0 | if ((k = strlen(s)) >= 255) |
289 | 0 | k = 255; |
290 | |
|
291 | 0 | if (!(d = avahi_dns_packet_extend(p, k+1))) |
292 | 0 | return NULL; |
293 | | |
294 | 0 | *d = (uint8_t) k; |
295 | 0 | memcpy(d+1, s, k); |
296 | |
|
297 | 0 | return d; |
298 | 0 | } |
299 | | |
300 | 0 | uint8_t *avahi_dns_packet_extend(AvahiDnsPacket *p, size_t l) { |
301 | 0 | uint8_t *d; |
302 | |
|
303 | 0 | assert(p); |
304 | | |
305 | 0 | if (p->size+l > p->max_size) |
306 | 0 | return NULL; |
307 | | |
308 | 0 | d = AVAHI_DNS_PACKET_DATA(p) + p->size; |
309 | 0 | p->size += l; |
310 | |
|
311 | 0 | return d; |
312 | 0 | } |
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 | 0 | static int consume_labels(AvahiDnsPacket *p, unsigned idx, char *ret_name, size_t l) { |
351 | 0 | int ret = 0; |
352 | 0 | int compressed = 0; |
353 | 0 | int first_label = 1; |
354 | 0 | unsigned label_ptr; |
355 | 0 | int i; |
356 | 0 | assert(p && ret_name && l); |
357 | | |
358 | 0 | for (i = 0; i < AVAHI_DNS_LABELS_MAX; i++) { |
359 | 0 | uint8_t n; |
360 | |
|
361 | 0 | if (idx+1 > p->size) |
362 | 0 | return -1; |
363 | | |
364 | 0 | n = AVAHI_DNS_PACKET_DATA(p)[idx]; |
365 | |
|
366 | 0 | if (!n) { |
367 | 0 | idx++; |
368 | 0 | if (!compressed) |
369 | 0 | ret++; |
370 | |
|
371 | 0 | if (l < 1) |
372 | 0 | return -1; |
373 | 0 | *ret_name = 0; |
374 | |
|
375 | 0 | return ret; |
376 | |
|
377 | 0 | } else if (n <= 63) { |
378 | | /* Uncompressed label */ |
379 | 0 | idx++; |
380 | 0 | if (!compressed) |
381 | 0 | ret++; |
382 | |
|
383 | 0 | if (idx + n > p->size) |
384 | 0 | return -1; |
385 | | |
386 | 0 | if ((size_t) n + 1 > l) |
387 | 0 | return -1; |
388 | | |
389 | 0 | if (!first_label) { |
390 | 0 | *(ret_name++) = '.'; |
391 | 0 | l--; |
392 | 0 | } else |
393 | 0 | first_label = 0; |
394 | |
|
395 | 0 | if (!(avahi_escape_label((char*) AVAHI_DNS_PACKET_DATA(p) + idx, n, &ret_name, &l))) |
396 | 0 | return -1; |
397 | | |
398 | 0 | idx += n; |
399 | |
|
400 | 0 | if (!compressed) |
401 | 0 | ret += n; |
402 | 0 | } else if ((n & 0xC0) == 0xC0) { |
403 | | /* Compressed label */ |
404 | |
|
405 | 0 | if (idx+2 > p->size) |
406 | 0 | return -1; |
407 | | |
408 | 0 | label_ptr = ((unsigned) (AVAHI_DNS_PACKET_DATA(p)[idx] & ~0xC0)) << 8 | AVAHI_DNS_PACKET_DATA(p)[idx+1]; |
409 | |
|
410 | 0 | if ((label_ptr < AVAHI_DNS_PACKET_HEADER_SIZE) || (label_ptr >= idx)) |
411 | 0 | return -1; |
412 | | |
413 | 0 | idx = label_ptr; |
414 | |
|
415 | 0 | if (!compressed) |
416 | 0 | ret += 2; |
417 | |
|
418 | 0 | compressed = 1; |
419 | 0 | } else |
420 | 0 | return -1; |
421 | 0 | } |
422 | | |
423 | 0 | return -1; |
424 | 0 | } |
425 | | |
426 | 0 | int avahi_dns_packet_consume_name(AvahiDnsPacket *p, char *ret_name, size_t l) { |
427 | 0 | int r; |
428 | |
|
429 | 0 | if ((r = consume_labels(p, p->rindex, ret_name, l)) < 0) |
430 | 0 | return -1; |
431 | | |
432 | 0 | p->rindex += r; |
433 | 0 | return 0; |
434 | 0 | } |
435 | | |
436 | 0 | int avahi_dns_packet_consume_uint16(AvahiDnsPacket *p, uint16_t *ret_v) { |
437 | 0 | uint8_t *d; |
438 | |
|
439 | 0 | assert(p); |
440 | 0 | assert(ret_v); |
441 | | |
442 | 0 | if (p->rindex + sizeof(uint16_t) > p->size) |
443 | 0 | return -1; |
444 | | |
445 | 0 | d = (uint8_t*) (AVAHI_DNS_PACKET_DATA(p) + p->rindex); |
446 | 0 | *ret_v = (d[0] << 8) | d[1]; |
447 | 0 | p->rindex += sizeof(uint16_t); |
448 | |
|
449 | 0 | return 0; |
450 | 0 | } |
451 | | |
452 | 0 | int avahi_dns_packet_consume_uint32(AvahiDnsPacket *p, uint32_t *ret_v) { |
453 | 0 | uint8_t* d; |
454 | |
|
455 | 0 | assert(p); |
456 | 0 | assert(ret_v); |
457 | | |
458 | 0 | if (p->rindex + sizeof(uint32_t) > p->size) |
459 | 0 | return -1; |
460 | | |
461 | 0 | d = (uint8_t*) (AVAHI_DNS_PACKET_DATA(p) + p->rindex); |
462 | 0 | *ret_v = ((uint32_t)d[0] << 24) | ((uint32_t)d[1] << 16) | ((uint32_t)d[2] << 8) | (uint32_t)d[3]; |
463 | 0 | p->rindex += sizeof(uint32_t); |
464 | |
|
465 | 0 | return 0; |
466 | 0 | } |
467 | | |
468 | 0 | int avahi_dns_packet_consume_bytes(AvahiDnsPacket *p, void * ret_data, size_t l) { |
469 | 0 | assert(p); |
470 | 0 | assert(ret_data); |
471 | 0 | assert(l > 0); |
472 | | |
473 | 0 | if (p->rindex + l > p->size) |
474 | 0 | return -1; |
475 | | |
476 | 0 | memcpy(ret_data, AVAHI_DNS_PACKET_DATA(p) + p->rindex, l); |
477 | 0 | p->rindex += l; |
478 | |
|
479 | 0 | return 0; |
480 | 0 | } |
481 | | |
482 | 0 | int avahi_dns_packet_consume_string(AvahiDnsPacket *p, char *ret_string, size_t l) { |
483 | 0 | size_t k; |
484 | |
|
485 | 0 | assert(p); |
486 | 0 | assert(ret_string); |
487 | 0 | assert(l > 0); |
488 | | |
489 | 0 | if (p->rindex >= p->size) |
490 | 0 | return -1; |
491 | | |
492 | 0 | k = AVAHI_DNS_PACKET_DATA(p)[p->rindex]; |
493 | |
|
494 | 0 | if (p->rindex+1+k > p->size) |
495 | 0 | return -1; |
496 | | |
497 | 0 | if (l > k+1) |
498 | 0 | l = k+1; |
499 | |
|
500 | 0 | memcpy(ret_string, AVAHI_DNS_PACKET_DATA(p)+p->rindex+1, l-1); |
501 | 0 | ret_string[l-1] = 0; |
502 | |
|
503 | 0 | p->rindex += 1+k; |
504 | |
|
505 | 0 | return 0; |
506 | 0 | } |
507 | | |
508 | 0 | const void* avahi_dns_packet_get_rptr(AvahiDnsPacket *p) { |
509 | 0 | assert(p); |
510 | | |
511 | 0 | if (p->rindex > p->size) |
512 | 0 | return NULL; |
513 | | |
514 | 0 | return AVAHI_DNS_PACKET_DATA(p) + p->rindex; |
515 | 0 | } |
516 | | |
517 | 0 | int avahi_dns_packet_skip(AvahiDnsPacket *p, size_t length) { |
518 | 0 | assert(p); |
519 | | |
520 | 0 | if (p->rindex + length > p->size) |
521 | 0 | return -1; |
522 | | |
523 | 0 | p->rindex += length; |
524 | 0 | return 0; |
525 | 0 | } |
526 | | |
527 | 0 | static int parse_rdata(AvahiDnsPacket *p, AvahiRecord *r, uint16_t rdlength) { |
528 | 0 | char buf[AVAHI_DOMAIN_NAME_MAX]; |
529 | 0 | const void* start; |
530 | |
|
531 | 0 | assert(p); |
532 | 0 | assert(r); |
533 | | |
534 | 0 | start = avahi_dns_packet_get_rptr(p); |
535 | |
|
536 | 0 | switch (r->key->type) { |
537 | 0 | case AVAHI_DNS_TYPE_PTR: |
538 | 0 | case AVAHI_DNS_TYPE_CNAME: |
539 | 0 | case AVAHI_DNS_TYPE_NS: |
540 | |
|
541 | 0 | if (avahi_dns_packet_consume_name(p, buf, sizeof(buf)) < 0) |
542 | 0 | return -1; |
543 | | |
544 | 0 | if (!(r->data.ptr.name = avahi_strdup(buf))) |
545 | 0 | return -1; |
546 | | |
547 | 0 | break; |
548 | | |
549 | | |
550 | 0 | case AVAHI_DNS_TYPE_SRV: |
551 | |
|
552 | 0 | if (avahi_dns_packet_consume_uint16(p, &r->data.srv.priority) < 0 || |
553 | 0 | avahi_dns_packet_consume_uint16(p, &r->data.srv.weight) < 0 || |
554 | 0 | avahi_dns_packet_consume_uint16(p, &r->data.srv.port) < 0 || |
555 | 0 | avahi_dns_packet_consume_name(p, buf, sizeof(buf)) < 0) |
556 | 0 | return -1; |
557 | | |
558 | 0 | if (!(r->data.srv.name = avahi_strdup(buf))) |
559 | 0 | return -1; |
560 | | |
561 | 0 | break; |
562 | | |
563 | 0 | case AVAHI_DNS_TYPE_HINFO: |
564 | |
|
565 | 0 | if (avahi_dns_packet_consume_string(p, buf, sizeof(buf)) < 0) |
566 | 0 | return -1; |
567 | | |
568 | 0 | if (!(r->data.hinfo.cpu = avahi_strdup(buf))) |
569 | 0 | return -1; |
570 | | |
571 | 0 | if (avahi_dns_packet_consume_string(p, buf, sizeof(buf)) < 0) |
572 | 0 | return -1; |
573 | | |
574 | 0 | if (!(r->data.hinfo.os = avahi_strdup(buf))) |
575 | 0 | return -1; |
576 | | |
577 | 0 | break; |
578 | | |
579 | 0 | case AVAHI_DNS_TYPE_TXT: |
580 | |
|
581 | 0 | if (rdlength > 0) { |
582 | 0 | if (avahi_string_list_parse(avahi_dns_packet_get_rptr(p), rdlength, &r->data.txt.string_list) < 0) |
583 | 0 | return -1; |
584 | | |
585 | 0 | if (avahi_dns_packet_skip(p, rdlength) < 0) |
586 | 0 | return -1; |
587 | 0 | } else |
588 | 0 | r->data.txt.string_list = NULL; |
589 | | |
590 | 0 | break; |
591 | | |
592 | 0 | case AVAHI_DNS_TYPE_A: |
593 | | |
594 | | /* avahi_log_debug("A"); */ |
595 | |
|
596 | 0 | if (avahi_dns_packet_consume_bytes(p, &r->data.a.address, sizeof(AvahiIPv4Address)) < 0) |
597 | 0 | return -1; |
598 | | |
599 | 0 | break; |
600 | | |
601 | 0 | case AVAHI_DNS_TYPE_AAAA: |
602 | | |
603 | | /* avahi_log_debug("aaaa"); */ |
604 | |
|
605 | 0 | if (avahi_dns_packet_consume_bytes(p, &r->data.aaaa.address, sizeof(AvahiIPv6Address)) < 0) |
606 | 0 | return -1; |
607 | | |
608 | 0 | break; |
609 | | |
610 | 0 | default: |
611 | | |
612 | | /* avahi_log_debug("generic"); */ |
613 | |
|
614 | 0 | if (rdlength > 0) { |
615 | |
|
616 | 0 | if (!(r->data.generic.data = avahi_memdup(avahi_dns_packet_get_rptr(p), rdlength))) |
617 | 0 | return -1; |
618 | | |
619 | 0 | r->data.generic.size = rdlength; |
620 | |
|
621 | 0 | if (avahi_dns_packet_skip(p, rdlength) < 0) |
622 | 0 | return -1; |
623 | 0 | } |
624 | | |
625 | 0 | break; |
626 | 0 | } |
627 | | |
628 | | /* Check if we read enough data */ |
629 | 0 | if ((const uint8_t*) avahi_dns_packet_get_rptr(p) - (const uint8_t*) start != rdlength) |
630 | 0 | return -1; |
631 | | |
632 | 0 | return 0; |
633 | 0 | } |
634 | | |
635 | 0 | AvahiRecord* avahi_dns_packet_consume_record(AvahiDnsPacket *p, int *ret_cache_flush) { |
636 | 0 | char name[AVAHI_DOMAIN_NAME_MAX]; |
637 | 0 | uint16_t type, class; |
638 | 0 | uint32_t ttl; |
639 | 0 | uint16_t rdlength; |
640 | 0 | AvahiRecord *r = NULL; |
641 | |
|
642 | 0 | assert(p); |
643 | | |
644 | 0 | if (avahi_dns_packet_consume_name(p, name, sizeof(name)) < 0 || |
645 | 0 | avahi_dns_packet_consume_uint16(p, &type) < 0 || |
646 | 0 | avahi_dns_packet_consume_uint16(p, &class) < 0 || |
647 | 0 | avahi_dns_packet_consume_uint32(p, &ttl) < 0 || |
648 | 0 | avahi_dns_packet_consume_uint16(p, &rdlength) < 0 || |
649 | 0 | p->rindex + rdlength > p->size) |
650 | 0 | goto fail; |
651 | | |
652 | 0 | if (ret_cache_flush) |
653 | 0 | *ret_cache_flush = !!(class & AVAHI_DNS_CACHE_FLUSH); |
654 | 0 | class &= ~AVAHI_DNS_CACHE_FLUSH; |
655 | |
|
656 | 0 | if (!(r = avahi_record_new_full(name, class, type, ttl))) |
657 | 0 | goto fail; |
658 | | |
659 | 0 | if (parse_rdata(p, r, rdlength) < 0) |
660 | 0 | goto fail; |
661 | | |
662 | 0 | if (!avahi_record_is_valid(r)) |
663 | 0 | goto fail; |
664 | | |
665 | 0 | return r; |
666 | | |
667 | 0 | fail: |
668 | 0 | if (r) |
669 | 0 | avahi_record_unref(r); |
670 | |
|
671 | 0 | return NULL; |
672 | 0 | } |
673 | | |
674 | 0 | AvahiKey* avahi_dns_packet_consume_key(AvahiDnsPacket *p, int *ret_unicast_response) { |
675 | 0 | char name[AVAHI_DOMAIN_NAME_MAX]; |
676 | 0 | uint16_t type, class; |
677 | 0 | AvahiKey *k; |
678 | |
|
679 | 0 | assert(p); |
680 | | |
681 | 0 | if (avahi_dns_packet_consume_name(p, name, sizeof(name)) < 0 || |
682 | 0 | avahi_dns_packet_consume_uint16(p, &type) < 0 || |
683 | 0 | avahi_dns_packet_consume_uint16(p, &class) < 0) |
684 | 0 | return NULL; |
685 | | |
686 | 0 | if (ret_unicast_response) |
687 | 0 | *ret_unicast_response = !!(class & AVAHI_DNS_UNICAST_RESPONSE); |
688 | |
|
689 | 0 | class &= ~AVAHI_DNS_UNICAST_RESPONSE; |
690 | |
|
691 | 0 | if (!(k = avahi_key_new(name, class, type))) |
692 | 0 | return NULL; |
693 | | |
694 | 0 | if (!avahi_key_is_valid(k)) { |
695 | 0 | avahi_key_unref(k); |
696 | 0 | return NULL; |
697 | 0 | } |
698 | | |
699 | 0 | return k; |
700 | 0 | } |
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 | 0 | static int append_rdata(AvahiDnsPacket *p, AvahiRecord *r) { |
724 | 0 | assert(p); |
725 | 0 | assert(r); |
726 | | |
727 | 0 | switch (r->key->type) { |
728 | | |
729 | 0 | case AVAHI_DNS_TYPE_PTR: |
730 | 0 | case AVAHI_DNS_TYPE_CNAME: |
731 | 0 | case AVAHI_DNS_TYPE_NS: |
732 | |
|
733 | 0 | if (!(avahi_dns_packet_append_name(p, r->data.ptr.name))) |
734 | 0 | return -1; |
735 | | |
736 | 0 | break; |
737 | | |
738 | 0 | case AVAHI_DNS_TYPE_SRV: |
739 | |
|
740 | 0 | if (!avahi_dns_packet_append_uint16(p, r->data.srv.priority) || |
741 | 0 | !avahi_dns_packet_append_uint16(p, r->data.srv.weight) || |
742 | 0 | !avahi_dns_packet_append_uint16(p, r->data.srv.port) || |
743 | 0 | !avahi_dns_packet_append_name(p, r->data.srv.name)) |
744 | 0 | return -1; |
745 | | |
746 | 0 | break; |
747 | | |
748 | 0 | case AVAHI_DNS_TYPE_HINFO: |
749 | 0 | if (!avahi_dns_packet_append_string(p, r->data.hinfo.cpu) || |
750 | 0 | !avahi_dns_packet_append_string(p, r->data.hinfo.os)) |
751 | 0 | return -1; |
752 | | |
753 | 0 | break; |
754 | | |
755 | 0 | case AVAHI_DNS_TYPE_TXT: { |
756 | |
|
757 | 0 | uint8_t *data; |
758 | 0 | size_t n; |
759 | |
|
760 | 0 | n = avahi_string_list_serialize(r->data.txt.string_list, NULL, 0); |
761 | |
|
762 | 0 | if (!(data = avahi_dns_packet_extend(p, n))) |
763 | 0 | return -1; |
764 | | |
765 | 0 | avahi_string_list_serialize(r->data.txt.string_list, data, n); |
766 | 0 | break; |
767 | 0 | } |
768 | | |
769 | | |
770 | 0 | case AVAHI_DNS_TYPE_A: |
771 | |
|
772 | 0 | if (!avahi_dns_packet_append_bytes(p, &r->data.a.address, sizeof(r->data.a.address))) |
773 | 0 | return -1; |
774 | | |
775 | 0 | break; |
776 | | |
777 | 0 | case AVAHI_DNS_TYPE_AAAA: |
778 | |
|
779 | 0 | if (!avahi_dns_packet_append_bytes(p, &r->data.aaaa.address, sizeof(r->data.aaaa.address))) |
780 | 0 | return -1; |
781 | | |
782 | 0 | break; |
783 | | |
784 | 0 | default: |
785 | |
|
786 | 0 | if (r->data.generic.size) |
787 | 0 | if (!avahi_dns_packet_append_bytes(p, r->data.generic.data, r->data.generic.size)) |
788 | 0 | return -1; |
789 | | |
790 | 0 | break; |
791 | 0 | } |
792 | | |
793 | 0 | return 0; |
794 | 0 | } |
795 | | |
796 | | |
797 | 0 | uint8_t* avahi_dns_packet_append_record(AvahiDnsPacket *p, AvahiRecord *r, int cache_flush, unsigned max_ttl) { |
798 | 0 | uint8_t *t, *l, *start; |
799 | 0 | size_t size; |
800 | |
|
801 | 0 | assert(p); |
802 | 0 | assert(r); |
803 | | |
804 | 0 | size = p->size; |
805 | |
|
806 | 0 | if (!(t = avahi_dns_packet_append_name(p, r->key->name)) || |
807 | 0 | !avahi_dns_packet_append_uint16(p, r->key->type) || |
808 | 0 | !avahi_dns_packet_append_uint16(p, cache_flush ? (r->key->clazz | AVAHI_DNS_CACHE_FLUSH) : (r->key->clazz &~ AVAHI_DNS_CACHE_FLUSH)) || |
809 | 0 | !avahi_dns_packet_append_uint32(p, (max_ttl && r->ttl > max_ttl) ? max_ttl : r->ttl) || |
810 | 0 | !(l = avahi_dns_packet_append_uint16(p, 0))) |
811 | 0 | goto fail; |
812 | | |
813 | 0 | start = avahi_dns_packet_extend(p, 0); |
814 | |
|
815 | 0 | if (append_rdata(p, r) < 0) |
816 | 0 | goto fail; |
817 | | |
818 | 0 | size = avahi_dns_packet_extend(p, 0) - start; |
819 | 0 | assert(size <= AVAHI_DNS_RDATA_MAX); |
820 | | |
821 | | /* avahi_log_debug("appended %u", size); */ |
822 | | |
823 | 0 | l[0] = (uint8_t) ((uint16_t) size >> 8); |
824 | 0 | l[1] = (uint8_t) ((uint16_t) size); |
825 | |
|
826 | 0 | return t; |
827 | | |
828 | | |
829 | 0 | fail: |
830 | 0 | p->size = size; |
831 | 0 | avahi_dns_packet_cleanup_name_table(p); |
832 | |
|
833 | 0 | return NULL; |
834 | 0 | } |
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 | 0 | int avahi_rdata_parse(AvahiRecord *record, const void* rdata, size_t size) { |
870 | 0 | int ret; |
871 | 0 | AvahiDnsPacket p; |
872 | |
|
873 | 0 | assert(record); |
874 | 0 | 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 | 0 | if (size > AVAHI_DNS_RDATA_MAX) |
880 | 0 | return -1; |
881 | | |
882 | 0 | p.data = (void*) rdata; |
883 | 0 | p.max_size = p.size = size; |
884 | 0 | p.rindex = 0; |
885 | 0 | p.name_table = NULL; |
886 | |
|
887 | 0 | ret = parse_rdata(&p, record, size); |
888 | |
|
889 | 0 | assert(!p.name_table); |
890 | | |
891 | 0 | return ret; |
892 | 0 | } |
893 | | |
894 | 0 | size_t avahi_rdata_serialize(AvahiRecord *record, void *rdata, size_t max_size) { |
895 | 0 | int ret; |
896 | 0 | AvahiDnsPacket p; |
897 | |
|
898 | 0 | assert(record); |
899 | 0 | assert(rdata); |
900 | 0 | assert(max_size > 0); |
901 | | |
902 | 0 | p.data = (void*) rdata; |
903 | 0 | p.max_size = max_size; |
904 | 0 | p.size = p.rindex = 0; |
905 | 0 | p.name_table = NULL; |
906 | |
|
907 | 0 | ret = append_rdata(&p, record); |
908 | |
|
909 | 0 | if (p.name_table) |
910 | 0 | avahi_hashmap_free(p.name_table); |
911 | |
|
912 | 0 | if (ret < 0) |
913 | 0 | return (size_t) -1; |
914 | | |
915 | 0 | return p.size; |
916 | 0 | } |