/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 | 954 | AvahiDnsPacket* avahi_dns_packet_new(unsigned mtu) { |
40 | 954 | AvahiDnsPacket *p; |
41 | 954 | size_t max_size; |
42 | | |
43 | 954 | if (mtu <= 0) |
44 | 0 | max_size = AVAHI_DNS_PACKET_SIZE_MAX; |
45 | 954 | else if (mtu >= AVAHI_DNS_PACKET_EXTRA_SIZE) |
46 | 954 | max_size = mtu - AVAHI_DNS_PACKET_EXTRA_SIZE; |
47 | 0 | else |
48 | 0 | max_size = 0; |
49 | | |
50 | 954 | if (max_size < AVAHI_DNS_PACKET_HEADER_SIZE) |
51 | 8 | max_size = AVAHI_DNS_PACKET_HEADER_SIZE; |
52 | | |
53 | 954 | if (!(p = avahi_malloc(sizeof(AvahiDnsPacket) + max_size))) |
54 | 0 | return p; |
55 | | |
56 | 954 | p->size = p->rindex = AVAHI_DNS_PACKET_HEADER_SIZE; |
57 | 954 | p->max_size = max_size; |
58 | 954 | p->res_size = 0; |
59 | 954 | p->name_table = NULL; |
60 | 954 | p->data = NULL; |
61 | | |
62 | 954 | memset(AVAHI_DNS_PACKET_DATA(p), 0, p->size); |
63 | 954 | return p; |
64 | 954 | } |
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 | 954 | void avahi_dns_packet_free(AvahiDnsPacket *p) { |
126 | 954 | assert(p); |
127 | | |
128 | 954 | if (p->name_table) |
129 | 0 | avahi_hashmap_free(p->name_table); |
130 | | |
131 | 954 | avahi_free(p); |
132 | 954 | } |
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 | p->name_table = avahi_hashmap_new(avahi_string_hash, avahi_string_equal, avahi_free, NULL); |
215 | |
|
216 | 0 | if (!(u = avahi_strdup(pname))) |
217 | 0 | avahi_log_error("avahi_strdup() failed."); |
218 | 0 | else |
219 | 0 | avahi_hashmap_insert(p->name_table, u, d); |
220 | 0 | } |
221 | | |
222 | 0 | if (!(d = avahi_dns_packet_extend(p, 1))) |
223 | 0 | goto fail; |
224 | | |
225 | 0 | *d = 0; |
226 | |
|
227 | 0 | return saved_ptr; |
228 | | |
229 | 0 | fail: |
230 | 0 | p->size = saved_size; |
231 | 0 | avahi_dns_packet_cleanup_name_table(p); |
232 | |
|
233 | 0 | return NULL; |
234 | 0 | } |
235 | | |
236 | 0 | uint8_t* avahi_dns_packet_append_uint16(AvahiDnsPacket *p, uint16_t v) { |
237 | 0 | uint8_t *d; |
238 | 0 | assert(p); |
239 | | |
240 | 0 | if (!(d = avahi_dns_packet_extend(p, sizeof(uint16_t)))) |
241 | 0 | return NULL; |
242 | | |
243 | 0 | d[0] = (uint8_t) (v >> 8); |
244 | 0 | d[1] = (uint8_t) v; |
245 | 0 | return d; |
246 | 0 | } |
247 | | |
248 | 0 | uint8_t *avahi_dns_packet_append_uint32(AvahiDnsPacket *p, uint32_t v) { |
249 | 0 | uint8_t *d; |
250 | 0 | assert(p); |
251 | | |
252 | 0 | if (!(d = avahi_dns_packet_extend(p, sizeof(uint32_t)))) |
253 | 0 | return NULL; |
254 | | |
255 | 0 | d[0] = (uint8_t) (v >> 24); |
256 | 0 | d[1] = (uint8_t) (v >> 16); |
257 | 0 | d[2] = (uint8_t) (v >> 8); |
258 | 0 | d[3] = (uint8_t) v; |
259 | |
|
260 | 0 | return d; |
261 | 0 | } |
262 | | |
263 | 0 | uint8_t *avahi_dns_packet_append_bytes(AvahiDnsPacket *p, const void *b, size_t l) { |
264 | 0 | uint8_t* d; |
265 | |
|
266 | 0 | assert(p); |
267 | 0 | assert(b); |
268 | 0 | assert(l); |
269 | | |
270 | 0 | if (!(d = avahi_dns_packet_extend(p, l))) |
271 | 0 | return NULL; |
272 | | |
273 | 0 | memcpy(d, b, l); |
274 | 0 | return d; |
275 | 0 | } |
276 | | |
277 | 0 | uint8_t* avahi_dns_packet_append_string(AvahiDnsPacket *p, const char *s) { |
278 | 0 | uint8_t* d; |
279 | 0 | size_t k; |
280 | |
|
281 | 0 | assert(p); |
282 | 0 | assert(s); |
283 | | |
284 | 0 | if ((k = strlen(s)) >= 255) |
285 | 0 | k = 255; |
286 | |
|
287 | 0 | if (!(d = avahi_dns_packet_extend(p, k+1))) |
288 | 0 | return NULL; |
289 | | |
290 | 0 | *d = (uint8_t) k; |
291 | 0 | memcpy(d+1, s, k); |
292 | |
|
293 | 0 | return d; |
294 | 0 | } |
295 | | |
296 | 0 | uint8_t *avahi_dns_packet_extend(AvahiDnsPacket *p, size_t l) { |
297 | 0 | uint8_t *d; |
298 | |
|
299 | 0 | assert(p); |
300 | | |
301 | 0 | if (p->size+l > p->max_size) |
302 | 0 | return NULL; |
303 | | |
304 | 0 | d = AVAHI_DNS_PACKET_DATA(p) + p->size; |
305 | 0 | p->size += l; |
306 | |
|
307 | 0 | return d; |
308 | 0 | } |
309 | | |
310 | 0 | int avahi_dns_packet_check_valid(AvahiDnsPacket *p) { |
311 | 0 | uint16_t flags; |
312 | 0 | assert(p); |
313 | | |
314 | 0 | if (p->size < AVAHI_DNS_PACKET_HEADER_SIZE) |
315 | 0 | return -1; |
316 | | |
317 | 0 | flags = avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_FLAGS); |
318 | |
|
319 | 0 | if (flags & AVAHI_DNS_FLAG_OPCODE) |
320 | 0 | return -1; |
321 | | |
322 | 0 | return 0; |
323 | 0 | } |
324 | | |
325 | 0 | int avahi_dns_packet_check_valid_multicast(AvahiDnsPacket *p) { |
326 | 0 | uint16_t flags; |
327 | 0 | assert(p); |
328 | | |
329 | 0 | if (avahi_dns_packet_check_valid(p) < 0) |
330 | 0 | return -1; |
331 | | |
332 | 0 | flags = avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_FLAGS); |
333 | |
|
334 | 0 | if (flags & AVAHI_DNS_FLAG_RCODE) |
335 | 0 | return -1; |
336 | | |
337 | 0 | return 0; |
338 | 0 | } |
339 | | |
340 | 0 | int avahi_dns_packet_is_query(AvahiDnsPacket *p) { |
341 | 0 | assert(p); |
342 | | |
343 | 0 | return !(avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_FLAGS) & AVAHI_DNS_FLAG_QR); |
344 | 0 | } |
345 | | |
346 | 1.54k | static int consume_labels(AvahiDnsPacket *p, unsigned idx, char *ret_name, size_t l) { |
347 | 1.54k | int ret = 0; |
348 | 1.54k | int compressed = 0; |
349 | 1.54k | int first_label = 1; |
350 | 1.54k | unsigned label_ptr; |
351 | 1.54k | int i; |
352 | 1.54k | assert(p && ret_name && l); |
353 | | |
354 | 20.1k | for (i = 0; i < AVAHI_DNS_LABELS_MAX; i++) { |
355 | 20.1k | uint8_t n; |
356 | | |
357 | 20.1k | if (idx+1 > p->size) |
358 | 313 | return -1; |
359 | | |
360 | 19.7k | n = AVAHI_DNS_PACKET_DATA(p)[idx]; |
361 | | |
362 | 19.7k | if (!n) { |
363 | 1.00k | idx++; |
364 | 1.00k | if (!compressed) |
365 | 810 | ret++; |
366 | | |
367 | 1.00k | if (l < 1) |
368 | 0 | return -1; |
369 | 1.00k | *ret_name = 0; |
370 | | |
371 | 1.00k | return ret; |
372 | | |
373 | 18.7k | } else if (n <= 63) { |
374 | | /* Uncompressed label */ |
375 | 16.5k | idx++; |
376 | 16.5k | if (!compressed) |
377 | 13.8k | ret++; |
378 | | |
379 | 16.5k | if (idx + n > p->size) |
380 | 28 | return -1; |
381 | | |
382 | 16.5k | if ((size_t) n + 1 > l) |
383 | 23 | return -1; |
384 | | |
385 | 16.5k | if (!first_label) { |
386 | 15.5k | *(ret_name++) = '.'; |
387 | 15.5k | l--; |
388 | 15.5k | } else |
389 | 989 | first_label = 0; |
390 | | |
391 | 16.5k | if (!(avahi_escape_label((char*) AVAHI_DNS_PACKET_DATA(p) + idx, n, &ret_name, &l))) |
392 | 31 | return -1; |
393 | | |
394 | 16.4k | idx += n; |
395 | | |
396 | 16.4k | if (!compressed) |
397 | 13.8k | ret += n; |
398 | 16.4k | } else if ((n & 0xC0) == 0xC0) { |
399 | | /* Compressed label */ |
400 | | |
401 | 2.19k | if (idx+2 > p->size) |
402 | 6 | return -1; |
403 | | |
404 | 2.19k | label_ptr = ((unsigned) (AVAHI_DNS_PACKET_DATA(p)[idx] & ~0xC0)) << 8 | AVAHI_DNS_PACKET_DATA(p)[idx+1]; |
405 | | |
406 | 2.19k | if ((label_ptr < AVAHI_DNS_PACKET_HEADER_SIZE) || (label_ptr >= idx)) |
407 | 90 | return -1; |
408 | | |
409 | 2.10k | idx = label_ptr; |
410 | | |
411 | 2.10k | if (!compressed) |
412 | 262 | ret += 2; |
413 | | |
414 | 2.10k | compressed = 1; |
415 | 2.10k | } else |
416 | 28 | return -1; |
417 | 19.7k | } |
418 | | |
419 | 20 | return -1; |
420 | 1.54k | } |
421 | | |
422 | 1.54k | int avahi_dns_packet_consume_name(AvahiDnsPacket *p, char *ret_name, size_t l) { |
423 | 1.54k | int r; |
424 | | |
425 | 1.54k | if ((r = consume_labels(p, p->rindex, ret_name, l)) < 0) |
426 | 539 | return -1; |
427 | | |
428 | 1.00k | p->rindex += r; |
429 | 1.00k | return 0; |
430 | 1.54k | } |
431 | | |
432 | 1.99k | int avahi_dns_packet_consume_uint16(AvahiDnsPacket *p, uint16_t *ret_v) { |
433 | 1.99k | uint8_t *d; |
434 | | |
435 | 1.99k | assert(p); |
436 | 1.99k | assert(ret_v); |
437 | | |
438 | 1.99k | if (p->rindex + sizeof(uint16_t) > p->size) |
439 | 30 | return -1; |
440 | | |
441 | 1.96k | d = (uint8_t*) (AVAHI_DNS_PACKET_DATA(p) + p->rindex); |
442 | 1.96k | *ret_v = (d[0] << 8) | d[1]; |
443 | 1.96k | p->rindex += sizeof(uint16_t); |
444 | | |
445 | 1.96k | return 0; |
446 | 1.99k | } |
447 | | |
448 | 0 | int avahi_dns_packet_consume_uint32(AvahiDnsPacket *p, uint32_t *ret_v) { |
449 | 0 | uint8_t* d; |
450 | |
|
451 | 0 | assert(p); |
452 | 0 | assert(ret_v); |
453 | | |
454 | 0 | if (p->rindex + sizeof(uint32_t) > p->size) |
455 | 0 | return -1; |
456 | | |
457 | 0 | d = (uint8_t*) (AVAHI_DNS_PACKET_DATA(p) + p->rindex); |
458 | 0 | *ret_v = ((uint32_t)d[0] << 24) | ((uint32_t)d[1] << 16) | ((uint32_t)d[2] << 8) | (uint32_t)d[3]; |
459 | 0 | p->rindex += sizeof(uint32_t); |
460 | |
|
461 | 0 | return 0; |
462 | 0 | } |
463 | | |
464 | 0 | int avahi_dns_packet_consume_bytes(AvahiDnsPacket *p, void * ret_data, size_t l) { |
465 | 0 | assert(p); |
466 | 0 | assert(ret_data); |
467 | 0 | assert(l > 0); |
468 | | |
469 | 0 | if (p->rindex + l > p->size) |
470 | 0 | return -1; |
471 | | |
472 | 0 | memcpy(ret_data, AVAHI_DNS_PACKET_DATA(p) + p->rindex, l); |
473 | 0 | p->rindex += l; |
474 | |
|
475 | 0 | return 0; |
476 | 0 | } |
477 | | |
478 | 0 | int avahi_dns_packet_consume_string(AvahiDnsPacket *p, char *ret_string, size_t l) { |
479 | 0 | size_t k; |
480 | |
|
481 | 0 | assert(p); |
482 | 0 | assert(ret_string); |
483 | 0 | assert(l > 0); |
484 | | |
485 | 0 | if (p->rindex >= p->size) |
486 | 0 | return -1; |
487 | | |
488 | 0 | k = AVAHI_DNS_PACKET_DATA(p)[p->rindex]; |
489 | |
|
490 | 0 | if (p->rindex+1+k > p->size) |
491 | 0 | return -1; |
492 | | |
493 | 0 | if (l > k+1) |
494 | 0 | l = k+1; |
495 | |
|
496 | 0 | memcpy(ret_string, AVAHI_DNS_PACKET_DATA(p)+p->rindex+1, l-1); |
497 | 0 | ret_string[l-1] = 0; |
498 | |
|
499 | 0 | p->rindex += 1+k; |
500 | |
|
501 | 0 | return 0; |
502 | 0 | } |
503 | | |
504 | 0 | const void* avahi_dns_packet_get_rptr(AvahiDnsPacket *p) { |
505 | 0 | assert(p); |
506 | | |
507 | 0 | if (p->rindex > p->size) |
508 | 0 | return NULL; |
509 | | |
510 | 0 | return AVAHI_DNS_PACKET_DATA(p) + p->rindex; |
511 | 0 | } |
512 | | |
513 | 0 | int avahi_dns_packet_skip(AvahiDnsPacket *p, size_t length) { |
514 | 0 | assert(p); |
515 | | |
516 | 0 | if (p->rindex + length > p->size) |
517 | 0 | return -1; |
518 | | |
519 | 0 | p->rindex += length; |
520 | 0 | return 0; |
521 | 0 | } |
522 | | |
523 | 0 | static int parse_rdata(AvahiDnsPacket *p, AvahiRecord *r, uint16_t rdlength) { |
524 | 0 | char buf[AVAHI_DOMAIN_NAME_MAX]; |
525 | 0 | const void* start; |
526 | |
|
527 | 0 | assert(p); |
528 | 0 | assert(r); |
529 | | |
530 | 0 | start = avahi_dns_packet_get_rptr(p); |
531 | |
|
532 | 0 | switch (r->key->type) { |
533 | 0 | case AVAHI_DNS_TYPE_PTR: |
534 | 0 | case AVAHI_DNS_TYPE_CNAME: |
535 | 0 | case AVAHI_DNS_TYPE_NS: |
536 | |
|
537 | 0 | if (avahi_dns_packet_consume_name(p, buf, sizeof(buf)) < 0) |
538 | 0 | return -1; |
539 | | |
540 | 0 | r->data.ptr.name = avahi_strdup(buf); |
541 | 0 | break; |
542 | | |
543 | | |
544 | 0 | case AVAHI_DNS_TYPE_SRV: |
545 | |
|
546 | 0 | if (avahi_dns_packet_consume_uint16(p, &r->data.srv.priority) < 0 || |
547 | 0 | avahi_dns_packet_consume_uint16(p, &r->data.srv.weight) < 0 || |
548 | 0 | avahi_dns_packet_consume_uint16(p, &r->data.srv.port) < 0 || |
549 | 0 | avahi_dns_packet_consume_name(p, buf, sizeof(buf)) < 0) |
550 | 0 | return -1; |
551 | | |
552 | 0 | r->data.srv.name = avahi_strdup(buf); |
553 | 0 | break; |
554 | | |
555 | 0 | case AVAHI_DNS_TYPE_HINFO: |
556 | |
|
557 | 0 | if (avahi_dns_packet_consume_string(p, buf, sizeof(buf)) < 0) |
558 | 0 | return -1; |
559 | | |
560 | 0 | r->data.hinfo.cpu = avahi_strdup(buf); |
561 | |
|
562 | 0 | if (avahi_dns_packet_consume_string(p, buf, sizeof(buf)) < 0) |
563 | 0 | return -1; |
564 | | |
565 | 0 | r->data.hinfo.os = avahi_strdup(buf); |
566 | 0 | break; |
567 | | |
568 | 0 | case AVAHI_DNS_TYPE_TXT: |
569 | |
|
570 | 0 | if (rdlength > 0) { |
571 | 0 | if (avahi_string_list_parse(avahi_dns_packet_get_rptr(p), rdlength, &r->data.txt.string_list) < 0) |
572 | 0 | return -1; |
573 | | |
574 | 0 | if (avahi_dns_packet_skip(p, rdlength) < 0) |
575 | 0 | return -1; |
576 | 0 | } else |
577 | 0 | r->data.txt.string_list = NULL; |
578 | | |
579 | 0 | break; |
580 | | |
581 | 0 | case AVAHI_DNS_TYPE_A: |
582 | | |
583 | | /* avahi_log_debug("A"); */ |
584 | |
|
585 | 0 | if (avahi_dns_packet_consume_bytes(p, &r->data.a.address, sizeof(AvahiIPv4Address)) < 0) |
586 | 0 | return -1; |
587 | | |
588 | 0 | break; |
589 | | |
590 | 0 | case AVAHI_DNS_TYPE_AAAA: |
591 | | |
592 | | /* avahi_log_debug("aaaa"); */ |
593 | |
|
594 | 0 | if (avahi_dns_packet_consume_bytes(p, &r->data.aaaa.address, sizeof(AvahiIPv6Address)) < 0) |
595 | 0 | return -1; |
596 | | |
597 | 0 | break; |
598 | | |
599 | 0 | default: |
600 | | |
601 | | /* avahi_log_debug("generic"); */ |
602 | |
|
603 | 0 | if (rdlength > 0) { |
604 | |
|
605 | 0 | r->data.generic.data = avahi_memdup(avahi_dns_packet_get_rptr(p), rdlength); |
606 | 0 | r->data.generic.size = rdlength; |
607 | |
|
608 | 0 | if (avahi_dns_packet_skip(p, rdlength) < 0) |
609 | 0 | return -1; |
610 | 0 | } |
611 | | |
612 | 0 | break; |
613 | 0 | } |
614 | | |
615 | | /* Check if we read enough data */ |
616 | 0 | if ((const uint8_t*) avahi_dns_packet_get_rptr(p) - (const uint8_t*) start != rdlength) |
617 | 0 | return -1; |
618 | | |
619 | 0 | return 0; |
620 | 0 | } |
621 | | |
622 | 0 | AvahiRecord* avahi_dns_packet_consume_record(AvahiDnsPacket *p, int *ret_cache_flush) { |
623 | 0 | char name[AVAHI_DOMAIN_NAME_MAX]; |
624 | 0 | uint16_t type, class; |
625 | 0 | uint32_t ttl; |
626 | 0 | uint16_t rdlength; |
627 | 0 | AvahiRecord *r = NULL; |
628 | |
|
629 | 0 | assert(p); |
630 | | |
631 | 0 | if (avahi_dns_packet_consume_name(p, name, sizeof(name)) < 0 || |
632 | 0 | avahi_dns_packet_consume_uint16(p, &type) < 0 || |
633 | 0 | avahi_dns_packet_consume_uint16(p, &class) < 0 || |
634 | 0 | avahi_dns_packet_consume_uint32(p, &ttl) < 0 || |
635 | 0 | avahi_dns_packet_consume_uint16(p, &rdlength) < 0 || |
636 | 0 | p->rindex + rdlength > p->size) |
637 | 0 | goto fail; |
638 | | |
639 | 0 | if (ret_cache_flush) |
640 | 0 | *ret_cache_flush = !!(class & AVAHI_DNS_CACHE_FLUSH); |
641 | 0 | class &= ~AVAHI_DNS_CACHE_FLUSH; |
642 | |
|
643 | 0 | if (!(r = avahi_record_new_full(name, class, type, ttl))) |
644 | 0 | goto fail; |
645 | | |
646 | 0 | if (parse_rdata(p, r, rdlength) < 0) |
647 | 0 | goto fail; |
648 | | |
649 | 0 | if (!avahi_record_is_valid(r)) |
650 | 0 | goto fail; |
651 | | |
652 | 0 | return r; |
653 | | |
654 | 0 | fail: |
655 | 0 | if (r) |
656 | 0 | avahi_record_unref(r); |
657 | |
|
658 | 0 | return NULL; |
659 | 0 | } |
660 | | |
661 | 1.54k | AvahiKey* avahi_dns_packet_consume_key(AvahiDnsPacket *p, int *ret_unicast_response) { |
662 | 1.54k | char name[256]; |
663 | 1.54k | uint16_t type, class; |
664 | 1.54k | AvahiKey *k; |
665 | | |
666 | 1.54k | assert(p); |
667 | | |
668 | 1.54k | if (avahi_dns_packet_consume_name(p, name, sizeof(name)) < 0 || |
669 | 1.00k | avahi_dns_packet_consume_uint16(p, &type) < 0 || |
670 | 990 | avahi_dns_packet_consume_uint16(p, &class) < 0) |
671 | 569 | return NULL; |
672 | | |
673 | 978 | if (ret_unicast_response) |
674 | 0 | *ret_unicast_response = !!(class & AVAHI_DNS_UNICAST_RESPONSE); |
675 | | |
676 | 978 | class &= ~AVAHI_DNS_UNICAST_RESPONSE; |
677 | | |
678 | 978 | if (!(k = avahi_key_new(name, class, type))) |
679 | 76 | return NULL; |
680 | | |
681 | 902 | if (!avahi_key_is_valid(k)) { |
682 | 0 | avahi_key_unref(k); |
683 | 0 | return NULL; |
684 | 0 | } |
685 | | |
686 | 902 | return k; |
687 | 902 | } |
688 | | |
689 | 0 | uint8_t* avahi_dns_packet_append_key(AvahiDnsPacket *p, AvahiKey *k, int unicast_response) { |
690 | 0 | uint8_t *t; |
691 | 0 | size_t size; |
692 | |
|
693 | 0 | assert(p); |
694 | 0 | assert(k); |
695 | | |
696 | 0 | size = p->size; |
697 | |
|
698 | 0 | if (!(t = avahi_dns_packet_append_name(p, k->name)) || |
699 | 0 | !avahi_dns_packet_append_uint16(p, k->type) || |
700 | 0 | !avahi_dns_packet_append_uint16(p, k->clazz | (unicast_response ? AVAHI_DNS_UNICAST_RESPONSE : 0))) { |
701 | 0 | p->size = size; |
702 | 0 | avahi_dns_packet_cleanup_name_table(p); |
703 | |
|
704 | 0 | return NULL; |
705 | 0 | } |
706 | | |
707 | 0 | return t; |
708 | 0 | } |
709 | | |
710 | 0 | static int append_rdata(AvahiDnsPacket *p, AvahiRecord *r) { |
711 | 0 | assert(p); |
712 | 0 | assert(r); |
713 | | |
714 | 0 | switch (r->key->type) { |
715 | | |
716 | 0 | case AVAHI_DNS_TYPE_PTR: |
717 | 0 | case AVAHI_DNS_TYPE_CNAME: |
718 | 0 | case AVAHI_DNS_TYPE_NS: |
719 | |
|
720 | 0 | if (!(avahi_dns_packet_append_name(p, r->data.ptr.name))) |
721 | 0 | return -1; |
722 | | |
723 | 0 | break; |
724 | | |
725 | 0 | case AVAHI_DNS_TYPE_SRV: |
726 | |
|
727 | 0 | if (!avahi_dns_packet_append_uint16(p, r->data.srv.priority) || |
728 | 0 | !avahi_dns_packet_append_uint16(p, r->data.srv.weight) || |
729 | 0 | !avahi_dns_packet_append_uint16(p, r->data.srv.port) || |
730 | 0 | !avahi_dns_packet_append_name(p, r->data.srv.name)) |
731 | 0 | return -1; |
732 | | |
733 | 0 | break; |
734 | | |
735 | 0 | case AVAHI_DNS_TYPE_HINFO: |
736 | 0 | if (!avahi_dns_packet_append_string(p, r->data.hinfo.cpu) || |
737 | 0 | !avahi_dns_packet_append_string(p, r->data.hinfo.os)) |
738 | 0 | return -1; |
739 | | |
740 | 0 | break; |
741 | | |
742 | 0 | case AVAHI_DNS_TYPE_TXT: { |
743 | |
|
744 | 0 | uint8_t *data; |
745 | 0 | size_t n; |
746 | |
|
747 | 0 | n = avahi_string_list_serialize(r->data.txt.string_list, NULL, 0); |
748 | |
|
749 | 0 | if (!(data = avahi_dns_packet_extend(p, n))) |
750 | 0 | return -1; |
751 | | |
752 | 0 | avahi_string_list_serialize(r->data.txt.string_list, data, n); |
753 | 0 | break; |
754 | 0 | } |
755 | | |
756 | | |
757 | 0 | case AVAHI_DNS_TYPE_A: |
758 | |
|
759 | 0 | if (!avahi_dns_packet_append_bytes(p, &r->data.a.address, sizeof(r->data.a.address))) |
760 | 0 | return -1; |
761 | | |
762 | 0 | break; |
763 | | |
764 | 0 | case AVAHI_DNS_TYPE_AAAA: |
765 | |
|
766 | 0 | if (!avahi_dns_packet_append_bytes(p, &r->data.aaaa.address, sizeof(r->data.aaaa.address))) |
767 | 0 | return -1; |
768 | | |
769 | 0 | break; |
770 | | |
771 | 0 | default: |
772 | |
|
773 | 0 | if (r->data.generic.size) |
774 | 0 | if (!avahi_dns_packet_append_bytes(p, r->data.generic.data, r->data.generic.size)) |
775 | 0 | return -1; |
776 | | |
777 | 0 | break; |
778 | 0 | } |
779 | | |
780 | 0 | return 0; |
781 | 0 | } |
782 | | |
783 | | |
784 | 0 | uint8_t* avahi_dns_packet_append_record(AvahiDnsPacket *p, AvahiRecord *r, int cache_flush, unsigned max_ttl) { |
785 | 0 | uint8_t *t, *l, *start; |
786 | 0 | size_t size; |
787 | |
|
788 | 0 | assert(p); |
789 | 0 | assert(r); |
790 | | |
791 | 0 | size = p->size; |
792 | |
|
793 | 0 | if (!(t = avahi_dns_packet_append_name(p, r->key->name)) || |
794 | 0 | !avahi_dns_packet_append_uint16(p, r->key->type) || |
795 | 0 | !avahi_dns_packet_append_uint16(p, cache_flush ? (r->key->clazz | AVAHI_DNS_CACHE_FLUSH) : (r->key->clazz &~ AVAHI_DNS_CACHE_FLUSH)) || |
796 | 0 | !avahi_dns_packet_append_uint32(p, (max_ttl && r->ttl > max_ttl) ? max_ttl : r->ttl) || |
797 | 0 | !(l = avahi_dns_packet_append_uint16(p, 0))) |
798 | 0 | goto fail; |
799 | | |
800 | 0 | start = avahi_dns_packet_extend(p, 0); |
801 | |
|
802 | 0 | if (append_rdata(p, r) < 0) |
803 | 0 | goto fail; |
804 | | |
805 | 0 | size = avahi_dns_packet_extend(p, 0) - start; |
806 | 0 | assert(size <= AVAHI_DNS_RDATA_MAX); |
807 | | |
808 | | /* avahi_log_debug("appended %u", size); */ |
809 | | |
810 | 0 | l[0] = (uint8_t) ((uint16_t) size >> 8); |
811 | 0 | l[1] = (uint8_t) ((uint16_t) size); |
812 | |
|
813 | 0 | return t; |
814 | | |
815 | | |
816 | 0 | fail: |
817 | 0 | p->size = size; |
818 | 0 | avahi_dns_packet_cleanup_name_table(p); |
819 | |
|
820 | 0 | return NULL; |
821 | 0 | } |
822 | | |
823 | 0 | int avahi_dns_packet_is_empty(AvahiDnsPacket *p) { |
824 | 0 | assert(p); |
825 | | |
826 | 0 | return p->size <= AVAHI_DNS_PACKET_HEADER_SIZE; |
827 | 0 | } |
828 | | |
829 | 0 | size_t avahi_dns_packet_space(AvahiDnsPacket *p) { |
830 | 0 | assert(p); |
831 | | |
832 | 0 | assert(p->size <= p->max_size); |
833 | | |
834 | 0 | return p->max_size - p->size; |
835 | 0 | } |
836 | | |
837 | 0 | size_t avahi_dns_packet_reserve_size(AvahiDnsPacket *p, size_t res_size) { |
838 | 0 | assert(p); |
839 | | |
840 | 0 | assert(p->size + p->res_size <= p->max_size); |
841 | | |
842 | 0 | if ((p->size + p->res_size + res_size) <= p->max_size) |
843 | 0 | p->res_size += res_size; |
844 | |
|
845 | 0 | return p->res_size; |
846 | 0 | } |
847 | | |
848 | 0 | size_t avahi_dns_packet_reserved_space(AvahiDnsPacket *p) { |
849 | 0 | assert(p); |
850 | | |
851 | 0 | assert(p->size + p->res_size <= p->max_size); |
852 | | |
853 | 0 | return p->max_size - p->size - p->res_size; |
854 | 0 | } |
855 | | |
856 | 0 | int avahi_rdata_parse(AvahiRecord *record, const void* rdata, size_t size) { |
857 | 0 | int ret; |
858 | 0 | AvahiDnsPacket p; |
859 | |
|
860 | 0 | assert(record); |
861 | 0 | assert(rdata); |
862 | | |
863 | 0 | p.data = (void*) rdata; |
864 | 0 | p.max_size = p.size = size; |
865 | 0 | p.rindex = 0; |
866 | 0 | p.name_table = NULL; |
867 | |
|
868 | 0 | ret = parse_rdata(&p, record, size); |
869 | |
|
870 | 0 | assert(!p.name_table); |
871 | | |
872 | 0 | return ret; |
873 | 0 | } |
874 | | |
875 | 0 | size_t avahi_rdata_serialize(AvahiRecord *record, void *rdata, size_t max_size) { |
876 | 0 | int ret; |
877 | 0 | AvahiDnsPacket p; |
878 | |
|
879 | 0 | assert(record); |
880 | 0 | assert(rdata); |
881 | 0 | assert(max_size > 0); |
882 | | |
883 | 0 | p.data = (void*) rdata; |
884 | 0 | p.max_size = max_size; |
885 | 0 | p.size = p.rindex = 0; |
886 | 0 | p.name_table = NULL; |
887 | |
|
888 | 0 | ret = append_rdata(&p, record); |
889 | |
|
890 | 0 | if (p.name_table) |
891 | 0 | avahi_hashmap_free(p.name_table); |
892 | |
|
893 | 0 | if (ret < 0) |
894 | 0 | return (size_t) -1; |
895 | | |
896 | 0 | return p.size; |
897 | 0 | } |