4 This file is part of avahi.
6 avahi is free software; you can redistribute it and/or modify it
7 under the terms of the GNU Lesser General Public License as
8 published by the Free Software Foundation; either version 2.1 of the
9 License, or (at your option) any later version.
11 avahi is distributed in the hope that it will be useful, but WITHOUT
12 ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
13 or FITNESS FOR A PARTICULAR PURPOSE. See the GNU Lesser General
14 Public License for more details.
16 You should have received a copy of the GNU Lesser General Public
17 License along with avahi; if not, write to the Free Software
18 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
26 #include <netinet/in.h>
33 #include <avahi-common/domain.h>
34 #include <avahi-common/malloc.h>
39 AvahiDnsPacket* avahi_dns_packet_new(unsigned mtu) {
44 max_size = AVAHI_DNS_PACKET_MAX_SIZE;
45 else if (mtu >= AVAHI_DNS_PACKET_EXTRA_SIZE)
46 max_size = mtu - AVAHI_DNS_PACKET_EXTRA_SIZE;
50 if (max_size < AVAHI_DNS_PACKET_HEADER_SIZE)
51 max_size = AVAHI_DNS_PACKET_HEADER_SIZE;
53 if (!(p = avahi_malloc(sizeof(AvahiDnsPacket) + max_size)))
56 p->size = p->rindex = AVAHI_DNS_PACKET_HEADER_SIZE;
57 p->max_size = max_size;
60 memset(AVAHI_DNS_PACKET_DATA(p), 0, p->size);
64 AvahiDnsPacket* avahi_dns_packet_new_query(unsigned mtu) {
67 if (!(p = avahi_dns_packet_new(mtu)))
70 avahi_dns_packet_set_field(p, AVAHI_DNS_FIELD_FLAGS, AVAHI_DNS_FLAGS(0, 0, 0, 0, 0, 0, 0, 0, 0, 0));
74 AvahiDnsPacket* avahi_dns_packet_new_response(unsigned mtu, int aa) {
77 if (!(p = avahi_dns_packet_new(mtu)))
80 avahi_dns_packet_set_field(p, AVAHI_DNS_FIELD_FLAGS, AVAHI_DNS_FLAGS(1, 0, aa, 0, 0, 0, 0, 0, 0, 0));
84 AvahiDnsPacket* avahi_dns_packet_new_reply(AvahiDnsPacket* p, unsigned mtu, int copy_queries, int aa) {
88 if (!(r = avahi_dns_packet_new_response(mtu, aa)))
92 unsigned saved_rindex;
95 saved_rindex = p->rindex;
96 p->rindex = AVAHI_DNS_PACKET_HEADER_SIZE;
98 for (n = avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_QDCOUNT); n > 0; n--) {
100 int unicast_response;
102 if ((k = avahi_dns_packet_consume_key(p, &unicast_response))) {
103 avahi_dns_packet_append_key(r, k, unicast_response);
108 p->rindex = saved_rindex;
110 avahi_dns_packet_set_field(r, AVAHI_DNS_FIELD_QDCOUNT, avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_QDCOUNT));
113 avahi_dns_packet_set_field(r, AVAHI_DNS_FIELD_ID, avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_ID));
115 avahi_dns_packet_set_field(r, AVAHI_DNS_FIELD_FLAGS,
116 (avahi_dns_packet_get_field(r, AVAHI_DNS_FIELD_FLAGS) & ~AVAHI_DNS_FLAG_OPCODE) |
117 (avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_FLAGS) & AVAHI_DNS_FLAG_OPCODE));
123 void avahi_dns_packet_free(AvahiDnsPacket *p) {
127 avahi_hashmap_free(p->name_table);
132 void avahi_dns_packet_set_field(AvahiDnsPacket *p, unsigned idx, uint16_t v) {
134 assert(idx < AVAHI_DNS_PACKET_HEADER_SIZE);
136 ((uint16_t*) AVAHI_DNS_PACKET_DATA(p))[idx] = htons(v);
139 uint16_t avahi_dns_packet_get_field(AvahiDnsPacket *p, unsigned idx) {
141 assert(idx < AVAHI_DNS_PACKET_HEADER_SIZE);
143 return ntohs(((uint16_t*) AVAHI_DNS_PACKET_DATA(p))[idx]);
146 void avahi_dns_packet_inc_field(AvahiDnsPacket *p, unsigned idx) {
148 assert(idx < AVAHI_DNS_PACKET_HEADER_SIZE);
150 avahi_dns_packet_set_field(p, idx, avahi_dns_packet_get_field(p, idx) + 1);
153 uint8_t* avahi_dns_packet_append_name(AvahiDnsPacket *p, const char *name) {
154 uint8_t *d, *saved_ptr = NULL;
160 saved_size = p->size;
161 saved_ptr = avahi_dns_packet_extend(p, 0);
169 /* Check whether we can compress this name. */
171 if (p->name_table && (prev = avahi_hashmap_lookup(p->name_table, name))) {
174 assert(prev >= AVAHI_DNS_PACKET_DATA(p));
175 idx = (unsigned) (prev - AVAHI_DNS_PACKET_DATA(p));
177 assert(idx < p->size);
181 if (!(t = (uint16_t*) avahi_dns_packet_extend(p, sizeof(uint16_t))))
184 *t = htons((0xC000 | idx));
191 if (!(avahi_unescape_label(&name, label, sizeof(label))))
194 if (!(d = avahi_dns_packet_append_string(p, label)))
198 /* This works only for normalized domain names */
199 p->name_table = avahi_hashmap_new(avahi_string_hash, avahi_string_equal, avahi_free, NULL);
201 if (!(u = avahi_strdup(pname)))
202 avahi_log_error("avahi_strdup() failed.");
204 avahi_hashmap_insert(p->name_table, u, d);
207 if (!(d = avahi_dns_packet_extend(p, 1)))
215 p->size = saved_size;
219 uint8_t* avahi_dns_packet_append_uint16(AvahiDnsPacket *p, uint16_t v) {
223 if (!(d = avahi_dns_packet_extend(p, sizeof(uint16_t))))
226 *((uint16_t*) d) = htons(v);
230 uint8_t *avahi_dns_packet_append_uint32(AvahiDnsPacket *p, uint32_t v) {
234 if (!(d = avahi_dns_packet_extend(p, sizeof(uint32_t))))
237 *((uint32_t*) d) = htonl(v);
242 uint8_t *avahi_dns_packet_append_bytes(AvahiDnsPacket *p, const void *b, size_t l) {
249 if (!(d = avahi_dns_packet_extend(p, l)))
256 uint8_t* avahi_dns_packet_append_string(AvahiDnsPacket *p, const char *s) {
263 if ((k = strlen(s)) >= 255)
266 if (!(d = avahi_dns_packet_extend(p, k+1)))
275 uint8_t *avahi_dns_packet_extend(AvahiDnsPacket *p, size_t l) {
280 if (p->size+l > p->max_size)
283 d = AVAHI_DNS_PACKET_DATA(p) + p->size;
289 int avahi_dns_packet_check_valid(AvahiDnsPacket *p) {
293 if (p->size < AVAHI_DNS_PACKET_HEADER_SIZE)
296 flags = avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_FLAGS);
298 if (flags & AVAHI_DNS_FLAG_OPCODE)
304 int avahi_dns_packet_check_valid_multicast(AvahiDnsPacket *p) {
308 if (avahi_dns_packet_check_valid(p) < 0)
311 flags = avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_FLAGS);
313 if (flags & AVAHI_DNS_FLAG_RCODE)
320 int avahi_dns_packet_is_query(AvahiDnsPacket *p) {
323 return !(avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_FLAGS) & AVAHI_DNS_FLAG_QR);
326 static int consume_labels(AvahiDnsPacket *p, unsigned idx, char *ret_name, size_t l) {
330 assert(p && ret_name && l);
338 n = AVAHI_DNS_PACKET_DATA(p)[idx];
351 } else if (n <= 63) {
352 /* Uncompressed label */
357 if (idx + n > p->size)
360 if ((size_t) n + 1 > l)
369 if (!(avahi_escape_label(AVAHI_DNS_PACKET_DATA(p) + idx, n, &ret_name, &l)))
376 } else if ((n & 0xC0) == 0xC0) {
377 /* Compressed label */
382 idx = ((unsigned) (AVAHI_DNS_PACKET_DATA(p)[idx] & ~0xC0)) << 8 | AVAHI_DNS_PACKET_DATA(p)[idx+1];
393 int avahi_dns_packet_consume_name(AvahiDnsPacket *p, char *ret_name, size_t l) {
396 if ((r = consume_labels(p, p->rindex, ret_name, l)) < 0)
403 int avahi_dns_packet_consume_uint16(AvahiDnsPacket *p, uint16_t *ret_v) {
407 if (p->rindex + sizeof(uint16_t) > p->size)
410 *ret_v = ntohs(*((uint16_t*) (AVAHI_DNS_PACKET_DATA(p) + p->rindex)));
411 p->rindex += sizeof(uint16_t);
416 int avahi_dns_packet_consume_uint32(AvahiDnsPacket *p, uint32_t *ret_v) {
420 if (p->rindex + sizeof(uint32_t) > p->size)
423 *ret_v = ntohl(*((uint32_t*) (AVAHI_DNS_PACKET_DATA(p) + p->rindex)));
424 p->rindex += sizeof(uint32_t);
429 int avahi_dns_packet_consume_bytes(AvahiDnsPacket *p, void * ret_data, size_t l) {
434 if (p->rindex + l > p->size)
437 memcpy(ret_data, AVAHI_DNS_PACKET_DATA(p) + p->rindex, l);
443 int avahi_dns_packet_consume_string(AvahiDnsPacket *p, char *ret_string, size_t l) {
450 if (p->rindex >= p->size)
453 k = AVAHI_DNS_PACKET_DATA(p)[p->rindex];
455 if (p->rindex+1+k > p->size)
461 memcpy(ret_string, AVAHI_DNS_PACKET_DATA(p)+p->rindex+1, l-1);
469 const void* avahi_dns_packet_get_rptr(AvahiDnsPacket *p) {
472 if (p->rindex > p->size)
475 return AVAHI_DNS_PACKET_DATA(p) + p->rindex;
478 int avahi_dns_packet_skip(AvahiDnsPacket *p, size_t length) {
481 if (p->rindex + length > p->size)
488 AvahiRecord* avahi_dns_packet_consume_record(AvahiDnsPacket *p, int *ret_cache_flush) {
489 char name[257], buf[257];
490 uint16_t type, class;
493 AvahiRecord *r = NULL;
498 /* avahi_log_debug("consume_record()"); */
500 if (avahi_dns_packet_consume_name(p, name, sizeof(name)) < 0 ||
501 avahi_dns_packet_consume_uint16(p, &type) < 0 ||
502 avahi_dns_packet_consume_uint16(p, &class) < 0 ||
503 avahi_dns_packet_consume_uint32(p, &ttl) < 0 ||
504 avahi_dns_packet_consume_uint16(p, &rdlength) < 0 ||
505 p->rindex + rdlength > p->size)
508 /* avahi_log_debug("name = %s, rdlength = %u", name, rdlength); */
511 *ret_cache_flush = !!(class & AVAHI_DNS_CACHE_FLUSH);
512 class &= ~AVAHI_DNS_CACHE_FLUSH;
514 start = avahi_dns_packet_get_rptr(p);
516 if (!(r = avahi_record_new_full(name, class, type, ttl)))
520 case AVAHI_DNS_TYPE_PTR:
521 case AVAHI_DNS_TYPE_CNAME:
523 /* avahi_log_debug("ptr"); */
525 if (avahi_dns_packet_consume_name(p, buf, sizeof(buf)) < 0)
528 r->data.ptr.name = avahi_strdup(buf);
532 case AVAHI_DNS_TYPE_SRV:
534 /* avahi_log_debug("srv"); */
536 if (avahi_dns_packet_consume_uint16(p, &r->data.srv.priority) < 0 ||
537 avahi_dns_packet_consume_uint16(p, &r->data.srv.weight) < 0 ||
538 avahi_dns_packet_consume_uint16(p, &r->data.srv.port) < 0 ||
539 avahi_dns_packet_consume_name(p, buf, sizeof(buf)) < 0)
542 r->data.srv.name = avahi_strdup(buf);
545 case AVAHI_DNS_TYPE_HINFO:
547 /* avahi_log_debug("hinfo"); */
549 if (avahi_dns_packet_consume_string(p, buf, sizeof(buf)) < 0)
552 r->data.hinfo.cpu = avahi_strdup(buf);
554 if (avahi_dns_packet_consume_string(p, buf, sizeof(buf)) < 0)
557 r->data.hinfo.os = avahi_strdup(buf);
560 case AVAHI_DNS_TYPE_TXT:
562 /* avahi_log_debug("txt"); */
565 r->data.txt.string_list = avahi_string_list_parse(avahi_dns_packet_get_rptr(p), rdlength);
567 if (avahi_dns_packet_skip(p, rdlength) < 0)
570 r->data.txt.string_list = NULL;
574 case AVAHI_DNS_TYPE_A:
576 /* avahi_log_debug("A"); */
578 if (avahi_dns_packet_consume_bytes(p, &r->data.a.address, sizeof(AvahiIPv4Address)) < 0)
583 case AVAHI_DNS_TYPE_AAAA:
585 /* avahi_log_debug("aaaa"); */
587 if (avahi_dns_packet_consume_bytes(p, &r->data.aaaa.address, sizeof(AvahiIPv6Address)) < 0)
594 /* avahi_log_debug("generic"); */
598 r->data.generic.data = avahi_memdup(avahi_dns_packet_get_rptr(p), rdlength);
600 if (avahi_dns_packet_skip(p, rdlength) < 0)
607 /* avahi_log_debug("%i == %u ?", (uint8_t*) avahi_dns_packet_get_rptr(p) - (uint8_t*) start, rdlength); */
609 /* Check if we read enough data */
610 if ((const uint8_t*) avahi_dns_packet_get_rptr(p) - (const uint8_t*) start != rdlength)
617 avahi_record_unref(r);
622 AvahiKey* avahi_dns_packet_consume_key(AvahiDnsPacket *p, int *ret_unicast_response) {
624 uint16_t type, class;
628 if (avahi_dns_packet_consume_name(p, name, sizeof(name)) < 0 ||
629 avahi_dns_packet_consume_uint16(p, &type) < 0 ||
630 avahi_dns_packet_consume_uint16(p, &class) < 0)
633 if (ret_unicast_response)
634 *ret_unicast_response = !!(class & AVAHI_DNS_UNICAST_RESPONSE);
636 class &= ~AVAHI_DNS_UNICAST_RESPONSE;
638 return avahi_key_new(name, class, type);
641 uint8_t* avahi_dns_packet_append_key(AvahiDnsPacket *p, AvahiKey *k, int unicast_response) {
650 if (!(t = avahi_dns_packet_append_name(p, k->name)) ||
651 !avahi_dns_packet_append_uint16(p, k->type) ||
652 !avahi_dns_packet_append_uint16(p, k->clazz | (unicast_response ? AVAHI_DNS_UNICAST_RESPONSE : 0))) {
660 uint8_t* avahi_dns_packet_append_record(AvahiDnsPacket *p, AvahiRecord *r, int cache_flush, unsigned max_ttl) {
661 uint8_t *t, *l, *start;
669 if (!(t = avahi_dns_packet_append_name(p, r->key->name)) ||
670 !avahi_dns_packet_append_uint16(p, r->key->type) ||
671 !avahi_dns_packet_append_uint16(p, cache_flush ? (r->key->clazz | AVAHI_DNS_CACHE_FLUSH) : (r->key->clazz &~ AVAHI_DNS_CACHE_FLUSH)) ||
672 !avahi_dns_packet_append_uint32(p, (max_ttl && r->ttl > max_ttl) ? max_ttl : r->ttl) ||
673 !(l = avahi_dns_packet_append_uint16(p, 0)))
676 start = avahi_dns_packet_extend(p, 0);
678 switch (r->key->type) {
680 case AVAHI_DNS_TYPE_PTR:
681 case AVAHI_DNS_TYPE_CNAME :
683 if (!(avahi_dns_packet_append_name(p, r->data.ptr.name)))
688 case AVAHI_DNS_TYPE_SRV:
690 if (!avahi_dns_packet_append_uint16(p, r->data.srv.priority) ||
691 !avahi_dns_packet_append_uint16(p, r->data.srv.weight) ||
692 !avahi_dns_packet_append_uint16(p, r->data.srv.port) ||
693 !avahi_dns_packet_append_name(p, r->data.srv.name))
698 case AVAHI_DNS_TYPE_HINFO:
699 if (!avahi_dns_packet_append_string(p, r->data.hinfo.cpu) ||
700 !avahi_dns_packet_append_string(p, r->data.hinfo.os))
705 case AVAHI_DNS_TYPE_TXT: {
710 n = avahi_string_list_serialize(r->data.txt.string_list, NULL, 0);
712 /* avahi_log_debug("appending string: %u %p", n, r->data.txt.string_list); */
714 if (!(data = avahi_dns_packet_extend(p, n)))
717 avahi_string_list_serialize(r->data.txt.string_list, data, n);
722 case AVAHI_DNS_TYPE_A:
724 if (!avahi_dns_packet_append_bytes(p, &r->data.a.address, sizeof(r->data.a.address)))
729 case AVAHI_DNS_TYPE_AAAA:
731 if (!avahi_dns_packet_append_bytes(p, &r->data.aaaa.address, sizeof(r->data.aaaa.address)))
738 if (r->data.generic.size &&
739 avahi_dns_packet_append_bytes(p, r->data.generic.data, r->data.generic.size))
748 size = avahi_dns_packet_extend(p, 0) - start;
749 assert(size <= 0xFFFF);
751 /* avahi_log_debug("appended %u", size); */
753 * (uint16_t*) l = htons((uint16_t) size);
763 int avahi_dns_packet_is_empty(AvahiDnsPacket *p) {
766 return p->size <= AVAHI_DNS_PACKET_HEADER_SIZE;
769 size_t avahi_dns_packet_space(AvahiDnsPacket *p) {
772 assert(p->size <= p->max_size);
774 return p->max_size - p->size;