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