/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 | 10.4k | AvahiDnsPacket* avahi_dns_packet_new(unsigned mtu) { |
40 | 10.4k | AvahiDnsPacket *p; |
41 | 10.4k | size_t max_size; |
42 | | |
43 | 10.4k | if (mtu <= 0) |
44 | 0 | max_size = AVAHI_DNS_PACKET_SIZE_MAX; |
45 | 10.4k | else if (mtu >= AVAHI_DNS_PACKET_EXTRA_SIZE) |
46 | 10.4k | max_size = mtu - AVAHI_DNS_PACKET_EXTRA_SIZE; |
47 | 0 | else |
48 | 0 | max_size = 0; |
49 | | |
50 | 10.4k | if (max_size < AVAHI_DNS_PACKET_HEADER_SIZE) |
51 | 25 | max_size = AVAHI_DNS_PACKET_HEADER_SIZE; |
52 | | |
53 | 10.4k | if (!(p = avahi_malloc(sizeof(AvahiDnsPacket) + max_size))) |
54 | 0 | return p; |
55 | | |
56 | 10.4k | p->size = p->rindex = AVAHI_DNS_PACKET_HEADER_SIZE; |
57 | 10.4k | p->max_size = max_size; |
58 | 10.4k | p->res_size = 0; |
59 | 10.4k | p->name_table = NULL; |
60 | 10.4k | p->data = NULL; |
61 | | |
62 | 10.4k | memset(AVAHI_DNS_PACKET_DATA(p), 0, p->size); |
63 | 10.4k | return p; |
64 | 10.4k | } |
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 | 10.4k | void avahi_dns_packet_free(AvahiDnsPacket *p) { |
126 | 10.4k | assert(p); |
127 | | |
128 | 10.4k | if (p->name_table) |
129 | 1.84k | avahi_hashmap_free(p->name_table); |
130 | | |
131 | 10.4k | avahi_free(p); |
132 | 10.4k | } |
133 | | |
134 | 116k | void avahi_dns_packet_set_field(AvahiDnsPacket *p, unsigned idx, uint16_t v) { |
135 | 116k | assert(p); |
136 | 116k | assert(idx < AVAHI_DNS_PACKET_HEADER_SIZE); |
137 | | |
138 | 116k | ((uint16_t*) AVAHI_DNS_PACKET_DATA(p))[idx] = htons(v); |
139 | 116k | } |
140 | | |
141 | 123k | uint16_t avahi_dns_packet_get_field(AvahiDnsPacket *p, unsigned idx) { |
142 | 123k | assert(p); |
143 | 123k | assert(idx < AVAHI_DNS_PACKET_HEADER_SIZE); |
144 | | |
145 | 123k | return ntohs(((uint16_t*) AVAHI_DNS_PACKET_DATA(p))[idx]); |
146 | 123k | } |
147 | | |
148 | 113k | void avahi_dns_packet_inc_field(AvahiDnsPacket *p, unsigned idx) { |
149 | 113k | assert(p); |
150 | 113k | assert(idx < AVAHI_DNS_PACKET_HEADER_SIZE); |
151 | | |
152 | 113k | avahi_dns_packet_set_field(p, idx, avahi_dns_packet_get_field(p, idx) + 1); |
153 | 113k | } |
154 | | |
155 | | |
156 | 27.0k | static void name_table_cleanup(void *key, void *value, void *user_data) { |
157 | 27.0k | AvahiDnsPacket *p = user_data; |
158 | | |
159 | 27.0k | if ((uint8_t*) value >= AVAHI_DNS_PACKET_DATA(p) + p->size) |
160 | 3.88k | avahi_hashmap_remove(p->name_table, key); |
161 | 27.0k | } |
162 | | |
163 | 1.11k | void avahi_dns_packet_cleanup_name_table(AvahiDnsPacket *p) { |
164 | 1.11k | if (p->name_table) |
165 | 1.04k | avahi_hashmap_foreach(p->name_table, name_table_cleanup, p); |
166 | 1.11k | } |
167 | | |
168 | 124k | uint8_t* avahi_dns_packet_append_name(AvahiDnsPacket *p, const char *name) { |
169 | 124k | uint8_t *d, *saved_ptr = NULL; |
170 | 124k | size_t saved_size; |
171 | | |
172 | 124k | assert(p); |
173 | 124k | assert(name); |
174 | | |
175 | 124k | saved_size = p->size; |
176 | 124k | saved_ptr = avahi_dns_packet_extend(p, 0); |
177 | | |
178 | 190k | while (*name) { |
179 | 79.9k | uint8_t* prev; |
180 | 79.9k | const char *pname; |
181 | 79.9k | char label[64], *u; |
182 | | |
183 | | /* Check whether we can compress this name. */ |
184 | | |
185 | 79.9k | if (p->name_table && (prev = avahi_hashmap_lookup(p->name_table, name))) { |
186 | 34.8k | unsigned idx; |
187 | | |
188 | 34.8k | assert(prev >= AVAHI_DNS_PACKET_DATA(p)); |
189 | 34.8k | idx = (unsigned) (prev - AVAHI_DNS_PACKET_DATA(p)); |
190 | | |
191 | 34.8k | assert(idx < p->size); |
192 | | |
193 | 34.8k | if (idx < 0x4000) { |
194 | 13.1k | uint8_t *t; |
195 | 13.1k | if (!(t = (uint8_t*) avahi_dns_packet_extend(p, sizeof(uint16_t)))) |
196 | 33 | return NULL; |
197 | | |
198 | 13.0k | t[0] = (uint8_t) ((0xC000 | idx) >> 8); |
199 | 13.0k | t[1] = (uint8_t) idx; |
200 | 13.0k | return saved_ptr; |
201 | 13.1k | } |
202 | 34.8k | } |
203 | | |
204 | 66.8k | pname = name; |
205 | | |
206 | 66.8k | if (!(avahi_unescape_label(&name, label, sizeof(label)))) |
207 | 0 | goto fail; |
208 | | |
209 | 66.8k | if (!(d = avahi_dns_packet_append_string(p, label))) |
210 | 314 | goto fail; |
211 | | |
212 | 66.5k | if (!p->name_table) |
213 | | /* This works only for normalized domain names */ |
214 | 2.43k | p->name_table = avahi_hashmap_new(avahi_string_hash, avahi_string_equal, avahi_free, NULL); |
215 | | |
216 | 66.5k | if (!(u = avahi_strdup(pname))) |
217 | 0 | avahi_log_error("avahi_strdup() failed."); |
218 | 66.5k | else |
219 | 66.5k | avahi_hashmap_insert(p->name_table, u, d); |
220 | 66.5k | } |
221 | | |
222 | 110k | if (!(d = avahi_dns_packet_extend(p, 1))) |
223 | 46 | goto fail; |
224 | | |
225 | 110k | *d = 0; |
226 | | |
227 | 110k | return saved_ptr; |
228 | | |
229 | 360 | fail: |
230 | 360 | p->size = saved_size; |
231 | 360 | avahi_dns_packet_cleanup_name_table(p); |
232 | | |
233 | 360 | return NULL; |
234 | 110k | } |
235 | | |
236 | 265k | uint8_t* avahi_dns_packet_append_uint16(AvahiDnsPacket *p, uint16_t v) { |
237 | 265k | uint8_t *d; |
238 | 265k | assert(p); |
239 | | |
240 | 265k | if (!(d = avahi_dns_packet_extend(p, sizeof(uint16_t)))) |
241 | 180 | return NULL; |
242 | | |
243 | 265k | d[0] = (uint8_t) (v >> 8); |
244 | 265k | d[1] = (uint8_t) v; |
245 | 265k | return d; |
246 | 265k | } |
247 | | |
248 | 29.4k | uint8_t *avahi_dns_packet_append_uint32(AvahiDnsPacket *p, uint32_t v) { |
249 | 29.4k | uint8_t *d; |
250 | 29.4k | assert(p); |
251 | | |
252 | 29.4k | if (!(d = avahi_dns_packet_extend(p, sizeof(uint32_t)))) |
253 | 45 | return NULL; |
254 | | |
255 | 29.4k | d[0] = (uint8_t) (v >> 24); |
256 | 29.4k | d[1] = (uint8_t) (v >> 16); |
257 | 29.4k | d[2] = (uint8_t) (v >> 8); |
258 | 29.4k | d[3] = (uint8_t) v; |
259 | | |
260 | 29.4k | return d; |
261 | 29.4k | } |
262 | | |
263 | 6.09k | uint8_t *avahi_dns_packet_append_bytes(AvahiDnsPacket *p, const void *b, size_t l) { |
264 | 6.09k | uint8_t* d; |
265 | | |
266 | 6.09k | assert(p); |
267 | 6.09k | assert(b); |
268 | 6.09k | assert(l); |
269 | | |
270 | 6.09k | if (!(d = avahi_dns_packet_extend(p, l))) |
271 | 56 | return NULL; |
272 | | |
273 | 6.03k | memcpy(d, b, l); |
274 | 6.03k | return d; |
275 | 6.09k | } |
276 | | |
277 | 72.5k | uint8_t* avahi_dns_packet_append_string(AvahiDnsPacket *p, const char *s) { |
278 | 72.5k | uint8_t* d; |
279 | 72.5k | size_t k; |
280 | | |
281 | 72.5k | assert(p); |
282 | 72.5k | assert(s); |
283 | | |
284 | 72.5k | if ((k = strlen(s)) >= 255) |
285 | 1.00k | k = 255; |
286 | | |
287 | 72.5k | if (!(d = avahi_dns_packet_extend(p, k+1))) |
288 | 351 | return NULL; |
289 | | |
290 | 72.2k | *d = (uint8_t) k; |
291 | 72.2k | memcpy(d+1, s, k); |
292 | | |
293 | 72.2k | return d; |
294 | 72.5k | } |
295 | | |
296 | 682k | uint8_t *avahi_dns_packet_extend(AvahiDnsPacket *p, size_t l) { |
297 | 682k | uint8_t *d; |
298 | | |
299 | 682k | assert(p); |
300 | | |
301 | 682k | if (p->size+l > p->max_size) |
302 | 752 | return NULL; |
303 | | |
304 | 681k | d = AVAHI_DNS_PACKET_DATA(p) + p->size; |
305 | 681k | p->size += l; |
306 | | |
307 | 681k | return d; |
308 | 682k | } |
309 | | |
310 | 2.62k | int avahi_dns_packet_check_valid(AvahiDnsPacket *p) { |
311 | 2.62k | uint16_t flags; |
312 | 2.62k | assert(p); |
313 | | |
314 | 2.62k | if (p->size < AVAHI_DNS_PACKET_HEADER_SIZE) |
315 | 9 | return -1; |
316 | | |
317 | 2.61k | flags = avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_FLAGS); |
318 | | |
319 | 2.61k | if (flags & AVAHI_DNS_FLAG_OPCODE) |
320 | 8 | return -1; |
321 | | |
322 | 2.60k | return 0; |
323 | 2.61k | } |
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 | 132k | static int consume_labels(AvahiDnsPacket *p, unsigned idx, char *ret_name, size_t l) { |
347 | 132k | int ret = 0; |
348 | 132k | int compressed = 0; |
349 | 132k | int first_label = 1; |
350 | 132k | unsigned label_ptr; |
351 | 132k | int i; |
352 | 132k | assert(p && ret_name && l); |
353 | | |
354 | 342k | for (i = 0; i < AVAHI_DNS_LABELS_MAX; i++) { |
355 | 342k | uint8_t n; |
356 | | |
357 | 342k | if (idx+1 > p->size) |
358 | 2.29k | return -1; |
359 | | |
360 | 340k | n = AVAHI_DNS_PACKET_DATA(p)[idx]; |
361 | | |
362 | 340k | if (!n) { |
363 | 129k | idx++; |
364 | 129k | if (!compressed) |
365 | 114k | ret++; |
366 | | |
367 | 129k | if (l < 1) |
368 | 0 | return -1; |
369 | 129k | *ret_name = 0; |
370 | | |
371 | 129k | return ret; |
372 | | |
373 | 210k | } else if (n <= 63) { |
374 | | /* Uncompressed label */ |
375 | 182k | idx++; |
376 | 182k | if (!compressed) |
377 | 75.7k | ret++; |
378 | | |
379 | 182k | if (idx + n > p->size) |
380 | 143 | return -1; |
381 | | |
382 | 181k | if ((size_t) n + 1 > l) |
383 | 26 | return -1; |
384 | | |
385 | 181k | if (!first_label) { |
386 | 162k | *(ret_name++) = '.'; |
387 | 162k | l--; |
388 | 162k | } else |
389 | 19.8k | first_label = 0; |
390 | | |
391 | 181k | if (!(avahi_escape_label((char*) AVAHI_DNS_PACKET_DATA(p) + idx, n, &ret_name, &l))) |
392 | 35 | return -1; |
393 | | |
394 | 181k | idx += n; |
395 | | |
396 | 181k | if (!compressed) |
397 | 75.5k | ret += n; |
398 | 181k | } else if ((n & 0xC0) == 0xC0) { |
399 | | /* Compressed label */ |
400 | | |
401 | 28.4k | if (idx+2 > p->size) |
402 | 34 | return -1; |
403 | | |
404 | 28.4k | label_ptr = ((unsigned) (AVAHI_DNS_PACKET_DATA(p)[idx] & ~0xC0)) << 8 | AVAHI_DNS_PACKET_DATA(p)[idx+1]; |
405 | | |
406 | 28.4k | if ((label_ptr < AVAHI_DNS_PACKET_HEADER_SIZE) || (label_ptr >= idx)) |
407 | 203 | return -1; |
408 | | |
409 | 28.2k | idx = label_ptr; |
410 | | |
411 | 28.2k | if (!compressed) |
412 | 15.6k | ret += 2; |
413 | | |
414 | 28.2k | compressed = 1; |
415 | 28.2k | } else |
416 | 86 | return -1; |
417 | 340k | } |
418 | | |
419 | 137 | return -1; |
420 | 132k | } |
421 | | |
422 | 132k | int avahi_dns_packet_consume_name(AvahiDnsPacket *p, char *ret_name, size_t l) { |
423 | 132k | int r; |
424 | | |
425 | 132k | if ((r = consume_labels(p, p->rindex, ret_name, l)) < 0) |
426 | 2.96k | return -1; |
427 | | |
428 | 129k | p->rindex += r; |
429 | 129k | return 0; |
430 | 132k | } |
431 | | |
432 | 277k | int avahi_dns_packet_consume_uint16(AvahiDnsPacket *p, uint16_t *ret_v) { |
433 | 277k | uint8_t *d; |
434 | | |
435 | 277k | assert(p); |
436 | 277k | assert(ret_v); |
437 | | |
438 | 277k | if (p->rindex + sizeof(uint16_t) > p->size) |
439 | 336 | return -1; |
440 | | |
441 | 277k | d = (uint8_t*) (AVAHI_DNS_PACKET_DATA(p) + p->rindex); |
442 | 277k | *ret_v = (d[0] << 8) | d[1]; |
443 | 277k | p->rindex += sizeof(uint16_t); |
444 | | |
445 | 277k | return 0; |
446 | 277k | } |
447 | | |
448 | 32.4k | int avahi_dns_packet_consume_uint32(AvahiDnsPacket *p, uint32_t *ret_v) { |
449 | 32.4k | uint8_t* d; |
450 | | |
451 | 32.4k | assert(p); |
452 | 32.4k | assert(ret_v); |
453 | | |
454 | 32.4k | if (p->rindex + sizeof(uint32_t) > p->size) |
455 | 54 | return -1; |
456 | | |
457 | 32.4k | d = (uint8_t*) (AVAHI_DNS_PACKET_DATA(p) + p->rindex); |
458 | 32.4k | *ret_v = ((uint32_t)d[0] << 24) | ((uint32_t)d[1] << 16) | ((uint32_t)d[2] << 8) | (uint32_t)d[3]; |
459 | 32.4k | p->rindex += sizeof(uint32_t); |
460 | | |
461 | 32.4k | return 0; |
462 | 32.4k | } |
463 | | |
464 | 2.41k | int avahi_dns_packet_consume_bytes(AvahiDnsPacket *p, void * ret_data, size_t l) { |
465 | 2.41k | assert(p); |
466 | 2.41k | assert(ret_data); |
467 | 2.41k | assert(l > 0); |
468 | | |
469 | 2.41k | if (p->rindex + l > p->size) |
470 | 59 | return -1; |
471 | | |
472 | 2.35k | memcpy(ret_data, AVAHI_DNS_PACKET_DATA(p) + p->rindex, l); |
473 | 2.35k | p->rindex += l; |
474 | | |
475 | 2.35k | return 0; |
476 | 2.41k | } |
477 | | |
478 | 6.76k | int avahi_dns_packet_consume_string(AvahiDnsPacket *p, char *ret_string, size_t l) { |
479 | 6.76k | size_t k; |
480 | | |
481 | 6.76k | assert(p); |
482 | 6.76k | assert(ret_string); |
483 | 6.76k | assert(l > 0); |
484 | | |
485 | 6.76k | if (p->rindex >= p->size) |
486 | 29 | return -1; |
487 | | |
488 | 6.73k | k = AVAHI_DNS_PACKET_DATA(p)[p->rindex]; |
489 | | |
490 | 6.73k | if (p->rindex+1+k > p->size) |
491 | 80 | return -1; |
492 | | |
493 | 6.65k | if (l > k+1) |
494 | 6.65k | l = k+1; |
495 | | |
496 | 6.65k | memcpy(ret_string, AVAHI_DNS_PACKET_DATA(p)+p->rindex+1, l-1); |
497 | 6.65k | ret_string[l-1] = 0; |
498 | | |
499 | 6.65k | p->rindex += 1+k; |
500 | | |
501 | 6.65k | return 0; |
502 | 6.73k | } |
503 | | |
504 | 74.8k | const void* avahi_dns_packet_get_rptr(AvahiDnsPacket *p) { |
505 | 74.8k | assert(p); |
506 | | |
507 | 74.8k | if (p->rindex > p->size) |
508 | 0 | return NULL; |
509 | | |
510 | 74.8k | return AVAHI_DNS_PACKET_DATA(p) + p->rindex; |
511 | 74.8k | } |
512 | | |
513 | 6.21k | int avahi_dns_packet_skip(AvahiDnsPacket *p, size_t length) { |
514 | 6.21k | assert(p); |
515 | | |
516 | 6.21k | if (p->rindex + length > p->size) |
517 | 0 | return -1; |
518 | | |
519 | 6.21k | p->rindex += length; |
520 | 6.21k | return 0; |
521 | 6.21k | } |
522 | | |
523 | 34.4k | static int parse_rdata(AvahiDnsPacket *p, AvahiRecord *r, uint16_t rdlength) { |
524 | 34.4k | char buf[AVAHI_DOMAIN_NAME_MAX]; |
525 | 34.4k | const void* start; |
526 | | |
527 | 34.4k | assert(p); |
528 | 34.4k | assert(r); |
529 | | |
530 | 34.4k | start = avahi_dns_packet_get_rptr(p); |
531 | | |
532 | 34.4k | switch (r->key->type) { |
533 | 4.71k | case AVAHI_DNS_TYPE_PTR: |
534 | 5.79k | case AVAHI_DNS_TYPE_CNAME: |
535 | 7.74k | case AVAHI_DNS_TYPE_NS: |
536 | | |
537 | 7.74k | if (avahi_dns_packet_consume_name(p, buf, sizeof(buf)) < 0) |
538 | 35 | return -1; |
539 | | |
540 | 7.70k | r->data.ptr.name = avahi_strdup(buf); |
541 | 7.70k | break; |
542 | | |
543 | | |
544 | 1.61k | case AVAHI_DNS_TYPE_SRV: |
545 | | |
546 | 1.61k | if (avahi_dns_packet_consume_uint16(p, &r->data.srv.priority) < 0 || |
547 | 1.60k | avahi_dns_packet_consume_uint16(p, &r->data.srv.weight) < 0 || |
548 | 1.57k | avahi_dns_packet_consume_uint16(p, &r->data.srv.port) < 0 || |
549 | 1.55k | avahi_dns_packet_consume_name(p, buf, sizeof(buf)) < 0) |
550 | 111 | return -1; |
551 | | |
552 | 1.50k | r->data.srv.name = avahi_strdup(buf); |
553 | 1.50k | break; |
554 | | |
555 | 3.40k | case AVAHI_DNS_TYPE_HINFO: |
556 | | |
557 | 3.40k | if (avahi_dns_packet_consume_string(p, buf, sizeof(buf)) < 0) |
558 | 48 | return -1; |
559 | | |
560 | 3.35k | r->data.hinfo.cpu = avahi_strdup(buf); |
561 | | |
562 | 3.35k | if (avahi_dns_packet_consume_string(p, buf, sizeof(buf)) < 0) |
563 | 61 | return -1; |
564 | | |
565 | 3.29k | r->data.hinfo.os = avahi_strdup(buf); |
566 | 3.29k | break; |
567 | | |
568 | 2.80k | case AVAHI_DNS_TYPE_TXT: |
569 | | |
570 | 2.80k | if (rdlength > 0) { |
571 | 2.02k | if (avahi_string_list_parse(avahi_dns_packet_get_rptr(p), rdlength, &r->data.txt.string_list) < 0) |
572 | 62 | return -1; |
573 | | |
574 | 1.96k | if (avahi_dns_packet_skip(p, rdlength) < 0) |
575 | 0 | return -1; |
576 | 1.96k | } else |
577 | 781 | r->data.txt.string_list = NULL; |
578 | | |
579 | 2.74k | break; |
580 | | |
581 | 2.74k | case AVAHI_DNS_TYPE_A: |
582 | | |
583 | | /* avahi_log_debug("A"); */ |
584 | | |
585 | 1.35k | if (avahi_dns_packet_consume_bytes(p, &r->data.a.address, sizeof(AvahiIPv4Address)) < 0) |
586 | 23 | return -1; |
587 | | |
588 | 1.33k | break; |
589 | | |
590 | 1.33k | case AVAHI_DNS_TYPE_AAAA: |
591 | | |
592 | | /* avahi_log_debug("aaaa"); */ |
593 | | |
594 | 1.06k | if (avahi_dns_packet_consume_bytes(p, &r->data.aaaa.address, sizeof(AvahiIPv6Address)) < 0) |
595 | 36 | return -1; |
596 | | |
597 | 1.02k | break; |
598 | | |
599 | 16.5k | default: |
600 | | |
601 | | /* avahi_log_debug("generic"); */ |
602 | | |
603 | 16.5k | if (rdlength > 0) { |
604 | | |
605 | 4.24k | r->data.generic.data = avahi_memdup(avahi_dns_packet_get_rptr(p), rdlength); |
606 | 4.24k | r->data.generic.size = rdlength; |
607 | | |
608 | 4.24k | if (avahi_dns_packet_skip(p, rdlength) < 0) |
609 | 0 | return -1; |
610 | 4.24k | } |
611 | | |
612 | 16.5k | break; |
613 | 34.4k | } |
614 | | |
615 | | /* Check if we read enough data */ |
616 | 34.1k | if ((const uint8_t*) avahi_dns_packet_get_rptr(p) - (const uint8_t*) start != rdlength) |
617 | 54 | return -1; |
618 | | |
619 | 34.0k | return 0; |
620 | 34.1k | } |
621 | | |
622 | 34.1k | AvahiRecord* avahi_dns_packet_consume_record(AvahiDnsPacket *p, int *ret_cache_flush) { |
623 | 34.1k | char name[AVAHI_DOMAIN_NAME_MAX]; |
624 | 34.1k | uint16_t type, class; |
625 | 34.1k | uint32_t ttl; |
626 | 34.1k | uint16_t rdlength; |
627 | 34.1k | AvahiRecord *r = NULL; |
628 | | |
629 | 34.1k | assert(p); |
630 | | |
631 | 34.1k | if (avahi_dns_packet_consume_name(p, name, sizeof(name)) < 0 || |
632 | 32.6k | avahi_dns_packet_consume_uint16(p, &type) < 0 || |
633 | 32.5k | avahi_dns_packet_consume_uint16(p, &class) < 0 || |
634 | 32.4k | avahi_dns_packet_consume_uint32(p, &ttl) < 0 || |
635 | 32.4k | avahi_dns_packet_consume_uint16(p, &rdlength) < 0 || |
636 | 32.3k | p->rindex + rdlength > p->size) |
637 | 1.85k | goto fail; |
638 | | |
639 | 32.3k | if (ret_cache_flush) |
640 | 28.4k | *ret_cache_flush = !!(class & AVAHI_DNS_CACHE_FLUSH); |
641 | 32.3k | class &= ~AVAHI_DNS_CACHE_FLUSH; |
642 | | |
643 | 32.3k | if (!(r = avahi_record_new_full(name, class, type, ttl))) |
644 | 34 | goto fail; |
645 | | |
646 | 32.2k | if (parse_rdata(p, r, rdlength) < 0) |
647 | 430 | goto fail; |
648 | | |
649 | 31.8k | if (!avahi_record_is_valid(r)) |
650 | 110 | goto fail; |
651 | | |
652 | 31.7k | return r; |
653 | | |
654 | 2.43k | fail: |
655 | 2.43k | if (r) |
656 | 540 | avahi_record_unref(r); |
657 | | |
658 | 2.43k | return NULL; |
659 | 31.8k | } |
660 | | |
661 | 88.9k | AvahiKey* avahi_dns_packet_consume_key(AvahiDnsPacket *p, int *ret_unicast_response) { |
662 | 88.9k | char name[AVAHI_DOMAIN_NAME_MAX]; |
663 | 88.9k | uint16_t type, class; |
664 | 88.9k | AvahiKey *k; |
665 | | |
666 | 88.9k | assert(p); |
667 | | |
668 | 88.9k | if (avahi_dns_packet_consume_name(p, name, sizeof(name)) < 0 || |
669 | 87.6k | avahi_dns_packet_consume_uint16(p, &type) < 0 || |
670 | 87.6k | avahi_dns_packet_consume_uint16(p, &class) < 0) |
671 | 1.41k | return NULL; |
672 | | |
673 | 87.5k | if (ret_unicast_response) |
674 | 86.5k | *ret_unicast_response = !!(class & AVAHI_DNS_UNICAST_RESPONSE); |
675 | | |
676 | 87.5k | class &= ~AVAHI_DNS_UNICAST_RESPONSE; |
677 | | |
678 | 87.5k | if (!(k = avahi_key_new(name, class, type))) |
679 | 190 | return NULL; |
680 | | |
681 | 87.3k | if (!avahi_key_is_valid(k)) { |
682 | 0 | avahi_key_unref(k); |
683 | 0 | return NULL; |
684 | 0 | } |
685 | | |
686 | 87.3k | return k; |
687 | 87.3k | } |
688 | | |
689 | 86.4k | uint8_t* avahi_dns_packet_append_key(AvahiDnsPacket *p, AvahiKey *k, int unicast_response) { |
690 | 86.4k | uint8_t *t; |
691 | 86.4k | size_t size; |
692 | | |
693 | 86.4k | assert(p); |
694 | 86.4k | assert(k); |
695 | | |
696 | 86.4k | size = p->size; |
697 | | |
698 | 86.4k | if (!(t = avahi_dns_packet_append_name(p, k->name)) || |
699 | 86.3k | !avahi_dns_packet_append_uint16(p, k->type) || |
700 | 86.3k | !avahi_dns_packet_append_uint16(p, k->clazz | (unicast_response ? AVAHI_DNS_UNICAST_RESPONSE : 0))) { |
701 | 69 | p->size = size; |
702 | 69 | avahi_dns_packet_cleanup_name_table(p); |
703 | | |
704 | 69 | return NULL; |
705 | 69 | } |
706 | | |
707 | 86.3k | return t; |
708 | 86.4k | } |
709 | | |
710 | 31.5k | static int append_rdata(AvahiDnsPacket *p, AvahiRecord *r) { |
711 | 31.5k | assert(p); |
712 | 31.5k | assert(r); |
713 | | |
714 | 31.5k | switch (r->key->type) { |
715 | | |
716 | 4.49k | case AVAHI_DNS_TYPE_PTR: |
717 | 5.35k | case AVAHI_DNS_TYPE_CNAME: |
718 | 7.05k | case AVAHI_DNS_TYPE_NS: |
719 | | |
720 | 7.05k | if (!(avahi_dns_packet_append_name(p, r->data.ptr.name))) |
721 | 295 | return -1; |
722 | | |
723 | 6.75k | break; |
724 | | |
725 | 6.75k | case AVAHI_DNS_TYPE_SRV: |
726 | | |
727 | 1.38k | if (!avahi_dns_packet_append_uint16(p, r->data.srv.priority) || |
728 | 1.37k | !avahi_dns_packet_append_uint16(p, r->data.srv.weight) || |
729 | 1.36k | !avahi_dns_packet_append_uint16(p, r->data.srv.port) || |
730 | 1.35k | !avahi_dns_packet_append_name(p, r->data.srv.name)) |
731 | 49 | return -1; |
732 | | |
733 | 1.33k | break; |
734 | | |
735 | 2.89k | case AVAHI_DNS_TYPE_HINFO: |
736 | 2.89k | if (!avahi_dns_packet_append_string(p, r->data.hinfo.cpu) || |
737 | 2.88k | !avahi_dns_packet_append_string(p, r->data.hinfo.os)) |
738 | 37 | return -1; |
739 | | |
740 | 2.85k | break; |
741 | | |
742 | 2.85k | case AVAHI_DNS_TYPE_TXT: { |
743 | | |
744 | 2.39k | uint8_t *data; |
745 | 2.39k | size_t n; |
746 | | |
747 | 2.39k | n = avahi_string_list_serialize(r->data.txt.string_list, NULL, 0); |
748 | | |
749 | 2.39k | if (!(data = avahi_dns_packet_extend(p, n))) |
750 | 41 | return -1; |
751 | | |
752 | 2.35k | avahi_string_list_serialize(r->data.txt.string_list, data, n); |
753 | 2.35k | break; |
754 | 2.39k | } |
755 | | |
756 | | |
757 | 1.29k | case AVAHI_DNS_TYPE_A: |
758 | | |
759 | 1.29k | if (!avahi_dns_packet_append_bytes(p, &r->data.a.address, sizeof(r->data.a.address))) |
760 | 13 | return -1; |
761 | | |
762 | 1.27k | break; |
763 | | |
764 | 1.27k | case AVAHI_DNS_TYPE_AAAA: |
765 | | |
766 | 973 | if (!avahi_dns_packet_append_bytes(p, &r->data.aaaa.address, sizeof(r->data.aaaa.address))) |
767 | 17 | return -1; |
768 | | |
769 | 956 | break; |
770 | | |
771 | 15.5k | default: |
772 | | |
773 | 15.5k | if (r->data.generic.size) |
774 | 3.83k | if (!avahi_dns_packet_append_bytes(p, r->data.generic.data, r->data.generic.size)) |
775 | 26 | return -1; |
776 | | |
777 | 15.5k | break; |
778 | 31.5k | } |
779 | | |
780 | 31.0k | return 0; |
781 | 31.5k | } |
782 | | |
783 | | |
784 | 29.5k | uint8_t* avahi_dns_packet_append_record(AvahiDnsPacket *p, AvahiRecord *r, int cache_flush, unsigned max_ttl) { |
785 | 29.5k | uint8_t *t, *l, *start; |
786 | 29.5k | size_t size; |
787 | | |
788 | 29.5k | assert(p); |
789 | 29.5k | assert(r); |
790 | | |
791 | 29.5k | size = p->size; |
792 | | |
793 | 29.5k | if (!(t = avahi_dns_packet_append_name(p, r->key->name)) || |
794 | 29.4k | !avahi_dns_packet_append_uint16(p, r->key->type) || |
795 | 29.4k | !avahi_dns_packet_append_uint16(p, cache_flush ? (r->key->clazz | AVAHI_DNS_CACHE_FLUSH) : (r->key->clazz &~ AVAHI_DNS_CACHE_FLUSH)) || |
796 | 29.4k | !avahi_dns_packet_append_uint32(p, (max_ttl && r->ttl > max_ttl) ? max_ttl : r->ttl) || |
797 | 29.4k | !(l = avahi_dns_packet_append_uint16(p, 0))) |
798 | 205 | goto fail; |
799 | | |
800 | 29.3k | start = avahi_dns_packet_extend(p, 0); |
801 | | |
802 | 29.3k | if (append_rdata(p, r) < 0) |
803 | 478 | goto fail; |
804 | | |
805 | 28.8k | size = avahi_dns_packet_extend(p, 0) - start; |
806 | 28.8k | assert(size <= AVAHI_DNS_RDATA_MAX); |
807 | | |
808 | | /* avahi_log_debug("appended %u", size); */ |
809 | | |
810 | 28.8k | l[0] = (uint8_t) ((uint16_t) size >> 8); |
811 | 28.8k | l[1] = (uint8_t) ((uint16_t) size); |
812 | | |
813 | 28.8k | return t; |
814 | | |
815 | | |
816 | 683 | fail: |
817 | 683 | p->size = size; |
818 | 683 | avahi_dns_packet_cleanup_name_table(p); |
819 | | |
820 | 683 | return NULL; |
821 | 28.8k | } |
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 | 2.20k | int avahi_rdata_parse(AvahiRecord *record, const void* rdata, size_t size) { |
857 | 2.20k | int ret; |
858 | 2.20k | AvahiDnsPacket p; |
859 | | |
860 | 2.20k | assert(record); |
861 | 2.20k | assert(rdata); |
862 | | |
863 | 2.20k | p.data = (void*) rdata; |
864 | 2.20k | p.max_size = p.size = size; |
865 | 2.20k | p.rindex = 0; |
866 | 2.20k | p.name_table = NULL; |
867 | | |
868 | 2.20k | ret = parse_rdata(&p, record, size); |
869 | | |
870 | 2.20k | assert(!p.name_table); |
871 | | |
872 | 2.20k | return ret; |
873 | 2.20k | } |
874 | | |
875 | 2.20k | size_t avahi_rdata_serialize(AvahiRecord *record, void *rdata, size_t max_size) { |
876 | 2.20k | int ret; |
877 | 2.20k | AvahiDnsPacket p; |
878 | | |
879 | 2.20k | assert(record); |
880 | 2.20k | assert(rdata); |
881 | 2.20k | assert(max_size > 0); |
882 | | |
883 | 2.20k | p.data = (void*) rdata; |
884 | 2.20k | p.max_size = max_size; |
885 | 2.20k | p.size = p.rindex = 0; |
886 | 2.20k | p.name_table = NULL; |
887 | | |
888 | 2.20k | ret = append_rdata(&p, record); |
889 | | |
890 | 2.20k | if (p.name_table) |
891 | 592 | avahi_hashmap_free(p.name_table); |
892 | | |
893 | 2.20k | if (ret < 0) |
894 | 0 | return (size_t) -1; |
895 | | |
896 | 2.20k | return p.size; |
897 | 2.20k | } |