avahi-core/server.c

   1 /* $Id$ */
   2
   3 /***
   4   This file is part of avahi.
   5
   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.
  10
  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.
  15
  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
  19   USA.
  20 ***/
  21
  22 #ifdef HAVE_CONFIG_H
  23 #include <config.h>
  24 #endif
  25
  26 #include <sys/socket.h>
  27 #include <arpa/inet.h>
  28 #include <string.h>
  29 #include <sys/utsname.h>
  30 #include <unistd.h>
  31
  32 #include "server.h"
  33 #include "util.h"
  34 #include "iface.h"
  35 #include "socket.h"
  36 #include "subscribe.h"
  37
  38 static void free_entry(AvahiServer*s, AvahiEntry *e) {
  39     AvahiEntry *t;
  40
  41     g_assert(s);
  42     g_assert(e);
  43
  44     avahi_goodbye_entry(s, e, TRUE);
  45
  46     /* Remove from linked list */
  47     AVAHI_LLIST_REMOVE(AvahiEntry, entries, s->entries, e);
  48
  49     /* Remove from hash table indexed by name */
  50     t = g_hash_table_lookup(s->entries_by_key, e->record->key);
  51     AVAHI_LLIST_REMOVE(AvahiEntry, by_key, t, e);
  52     if (t)
  53         g_hash_table_replace(s->entries_by_key, t->record->key, t);
  54     else
  55         g_hash_table_remove(s->entries_by_key, e->record->key);
  56
  57     /* Remove from associated group */
  58     if (e->group)
  59         AVAHI_LLIST_REMOVE(AvahiEntry, by_group, e->group->entries, e);
  60
  61     avahi_record_unref(e->record);
  62     g_free(e);
  63 }
  64
  65 static void free_group(AvahiServer *s, AvahiEntryGroup *g) {
  66     g_assert(s);
  67     g_assert(g);
  68
  69     while (g->entries)
  70         free_entry(s, g->entries);
  71
  72     AVAHI_LLIST_REMOVE(AvahiEntryGroup, groups, s->groups, g);
  73     g_free(g);
  74 }
  75
  76 static void cleanup_dead(AvahiServer *s) {
  77     AvahiEntryGroup *g, *ng;
  78     AvahiEntry *e, *ne;
  79     g_assert(s);
  80
  81
  82     if (s->need_group_cleanup) {
  83         for (g = s->groups; g; g = ng) {
  84             ng = g->groups_next;
  85
  86             if (g->dead)
  87                 free_group(s, g);
  88         }
  89
  90         s->need_group_cleanup = FALSE;
  91     }
  92
  93     if (s->need_entry_cleanup) {
  94         for (e = s->entries; e; e = ne) {
  95             ne = e->entries_next;
  96
  97             if (e->dead)
  98                 free_entry(s, e);
  99         }
 100
 101         s->need_entry_cleanup = FALSE;
 102     }
 103 }
 104
 105 static void enum_aux_records(AvahiServer *s, AvahiInterface *i, const gchar *name, guint16 type, void (*callback)(AvahiServer *s, AvahiRecord *r, gboolean flush_cache, gpointer userdata), gpointer userdata) {
 106     AvahiKey *k;
 107     AvahiEntry *e;
 108
 109     g_assert(s);
 110     g_assert(i);
 111     g_assert(name);
 112     g_assert(callback);
 113
 114     g_assert(type != AVAHI_DNS_TYPE_ANY);
 115
 116     k = avahi_key_new(name, AVAHI_DNS_CLASS_IN, type);
 117
 118     for (e = g_hash_table_lookup(s->entries_by_key, k); e; e = e->by_key_next)
 119         if (!e->dead && avahi_entry_registered(s, e, i))
 120             callback(s, e->record, e->flags & AVAHI_ENTRY_UNIQUE, userdata);
 121
 122     avahi_key_unref(k);
 123 }
 124
 125 void avahi_server_enumerate_aux_records(AvahiServer *s, AvahiInterface *i, AvahiRecord *r, void (*callback)(AvahiServer *s, AvahiRecord *r, gboolean flush_cache, gpointer userdata), gpointer userdata) {
 126     g_assert(s);
 127     g_assert(i);
 128     g_assert(r);
 129     g_assert(callback);
 130
 131     if (r->key->class == AVAHI_DNS_CLASS_IN) {
 132         if (r->key->type == AVAHI_DNS_TYPE_PTR) {
 133             enum_aux_records(s, i, r->data.ptr.name, AVAHI_DNS_TYPE_SRV, callback, userdata);
 134             enum_aux_records(s, i, r->data.ptr.name, AVAHI_DNS_TYPE_TXT, callback, userdata);
 135         } else if (r->key->type == AVAHI_DNS_TYPE_SRV) {
 136             enum_aux_records(s, i, r->data.srv.name, AVAHI_DNS_TYPE_A, callback, userdata);
 137             enum_aux_records(s, i, r->data.srv.name, AVAHI_DNS_TYPE_AAAA, callback, userdata);
 138         }
 139     }
 140 }
 141
 142 void avahi_server_prepare_response(AvahiServer *s, AvahiInterface *i, AvahiEntry *e, gboolean unicast_response, gboolean auxiliary) {
 143     g_assert(s);
 144     g_assert(i);
 145     g_assert(e);
 146
 147     avahi_record_list_push(s->record_list, e->record, e->flags & AVAHI_ENTRY_UNIQUE, unicast_response, auxiliary);
 148 }
 149
 150 void avahi_server_prepare_matching_responses(AvahiServer *s, AvahiInterface *i, AvahiKey *k, gboolean unicast_response) {
 151     AvahiEntry *e;
 152     gchar *txt;
 153
 154     g_assert(s);
 155     g_assert(i);
 156     g_assert(k);
 157
 158     g_message("Posting responses matching [%s]", txt = avahi_key_to_string(k));
 159     g_free(txt);
 160
 161     if (avahi_key_is_pattern(k)) {
 162
 163         /* Handle ANY query */
 164
 165         for (e = s->entries; e; e = e->entries_next)
 166             if (!e->dead && avahi_key_pattern_match(k, e->record->key) && avahi_entry_registered(s, e, i))
 167                 avahi_server_prepare_response(s, i, e, unicast_response, FALSE);
 168
 169     } else {
 170
 171         /* Handle all other queries */
 172
 173         for (e = g_hash_table_lookup(s->entries_by_key, k); e; e = e->by_key_next)
 174             if (!e->dead && avahi_entry_registered(s, e, i))
 175                 avahi_server_prepare_response(s, i, e, unicast_response, FALSE);
 176     }
 177 }
 178
 179 static void withdraw_entry(AvahiServer *s, AvahiEntry *e) {
 180     g_assert(s);
 181     g_assert(e);
 182
 183     if (e->group) {
 184         AvahiEntry *k;
 185
 186         for (k = e->group->entries; k; k = k->by_group_next) {
 187             avahi_goodbye_entry(s, k, FALSE);
 188             k->dead = TRUE;
 189         }
 190
 191         avahi_entry_group_change_state(e->group, AVAHI_ENTRY_GROUP_COLLISION);
 192     } else {
 193         avahi_goodbye_entry(s, e, FALSE);
 194         e->dead = TRUE;
 195     }
 196
 197     s->need_entry_cleanup = TRUE;
 198 }
 199
 200 static void withdraw_rrset(AvahiServer *s, AvahiKey *key) {
 201     AvahiEntry *e;
 202
 203     g_assert(s);
 204     g_assert(key);
 205
 206    for (e = g_hash_table_lookup(s->entries_by_key, key); e; e = e->by_key_next)
 207         withdraw_entry(s, e);
 208 }
 209
 210 static void incoming_probe(AvahiServer *s, AvahiRecord *record, AvahiInterface *i) {
 211     AvahiEntry *e, *n;
 212     gchar *t;
 213     gboolean ours = FALSE, won = FALSE, lost = FALSE;
 214
 215     g_assert(s);
 216     g_assert(record);
 217     g_assert(i);
 218
 219     for (e = g_hash_table_lookup(s->entries_by_key, record->key); e; e = n) {
 220         gint cmp;
 221         n = e->by_key_next;
 222
 223         if (e->dead || !avahi_entry_probing(s, e, i))
 224             continue;
 225
 226         if ((cmp = avahi_record_lexicographical_compare(e->record, record)) == 0) {
 227             ours = TRUE;
 228             break;
 229         } else if (cmp > 0)
 230             won = TRUE;
 231         else /* cmp < 0 */
 232             lost = TRUE;
 233     }
 234
 235     t = avahi_record_to_string(record);
 236
 237     if (!ours) {
 238
 239         if (won)
 240             g_message("Recieved conflicting probe [%s]. Local host won.", t);
 241         else if (lost) {
 242             g_message("Recieved conflicting probe [%s]. Local host lost. Withdrawing.", t);
 243             withdraw_rrset(s, record->key);
 244         }
 245     }
 246
 247     g_free(t);
 248 }
 249
 250 static gboolean handle_conflict(AvahiServer *s, AvahiInterface *i, AvahiRecord *record, gboolean unique, const AvahiAddress *a) {
 251     gboolean valid = TRUE, ours = FALSE, conflict = FALSE, withdraw_immediately = FALSE;
 252     AvahiEntry *e, *n, *conflicting_entry = NULL;
 253     gchar *t;
 254
 255     g_assert(s);
 256     g_assert(i);
 257     g_assert(record);
 258
 259     t = avahi_record_to_string(record);
 260
 261     g_message("CHECKING FOR CONFLICT: [%s]", t);
 262
 263     for (e = g_hash_table_lookup(s->entries_by_key, record->key); e; e = n) {
 264         n = e->by_key_next;
 265
 266         if (e->dead || (!(e->flags & AVAHI_ENTRY_UNIQUE) && !unique))
 267             continue;
 268
 269         /* Either our entry or the other is intended to be unique, so let's check */
 270
 271         if (avahi_entry_registered(s, e, i)) {
 272
 273             if (avahi_record_equal_no_ttl(e->record, record)) {
 274                 ours = TRUE; /* We have an identical record, so this is no conflict */
 275
 276                 /* Check wheter there is a TTL conflict */
 277                 if (record->ttl <= e->record->ttl/2) {
 278                     /* Refresh */
 279                     g_message("Recieved record with bad TTL [%s]. Refreshing.", t);
 280                     avahi_interface_post_response(i, e->record, FALSE, NULL, TRUE);
 281                     valid = FALSE;
 282                 }
 283
 284                 /* There's no need to check the other entries of this RRset */
 285                 break;
 286             } else {
 287                 /* A conflict => we have to return to probe mode */
 288                 conflict = TRUE;
 289                 conflicting_entry = e;
 290             }
 291
 292         } else if (avahi_entry_probing(s, e, i)) {
 293
 294             if (!avahi_record_equal_no_ttl(record, e->record)) {
 295
 296                 /* We are currently registering a matching record, but
 297                  * someone else already claimed it, so let's
 298                  * withdraw */
 299                 conflict = TRUE;
 300                 withdraw_immediately = TRUE;
 301             }
 302         }
 303     }
 304
 305 /*     g_message("ours=%i conflict=%i", ours, conflict); */
 306
 307     if (!ours && conflict) {
 308         valid = FALSE;
 309
 310         if (withdraw_immediately) {
 311             g_message("Recieved conflicting record [%s] with local record to be. Withdrawing.", t);
 312             withdraw_rrset(s, record->key);
 313         } else {
 314             g_assert(conflicting_entry);
 315             g_message("Recieved conflicting record [%s]. Resetting our record.", t);
 316             avahi_entry_return_to_initial_state(s, conflicting_entry, i);
 317
 318             /* Local unique records are returned to probin
 319              * state. Local shared records are reannounced. */
 320         }
 321     }
 322
 323     g_free(t);
 324
 325     return valid;
 326 }
 327
 328 static void append_aux_callback(AvahiServer *s, AvahiRecord *r, gboolean flush_cache, gpointer userdata) {
 329     gboolean *unicast_response = userdata;
 330
 331     g_assert(s);
 332     g_assert(r);
 333     g_assert(unicast_response);
 334
 335     avahi_record_list_push(s->record_list, r, flush_cache, *unicast_response, TRUE);
 336 }
 337
 338 static void append_aux_records_to_list(AvahiServer *s, AvahiInterface *i, AvahiRecord *r, gboolean unicast_response) {
 339     g_assert(s);
 340     g_assert(r);
 341
 342     avahi_server_enumerate_aux_records(s, i, r, append_aux_callback, &unicast_response);
 343 }
 344
 345 void avahi_server_generate_response(AvahiServer *s, AvahiInterface *i, AvahiDnsPacket *p, const AvahiAddress *a, guint16 port, gboolean legacy_unicast) {
 346
 347     g_assert(s);
 348     g_assert(i);
 349     g_assert(!legacy_unicast || (a && port > 0 && p));
 350
 351     if (legacy_unicast) {
 352         AvahiDnsPacket *reply;
 353         AvahiRecord *r;
 354
 355         reply = avahi_dns_packet_new_reply(p, 512 /* unicast DNS maximum packet size is 512 */ , TRUE, TRUE);
 356
 357         while ((r = avahi_record_list_next(s->record_list, NULL, NULL, NULL))) {
 358
 359             append_aux_records_to_list(s, i, r, FALSE);
 360
 361             if (avahi_dns_packet_append_record(reply, r, FALSE, 10))
 362                 avahi_dns_packet_inc_field(reply, AVAHI_DNS_FIELD_ANCOUNT);
 363             else {
 364                 gchar *t = avahi_record_to_string(r);
 365                 g_warning("Record [%s] not fitting in legacy unicast packet, dropping.", t);
 366                 g_free(t);
 367             }
 368
 369             avahi_record_unref(r);
 370         }
 371
 372         if (avahi_dns_packet_get_field(reply, AVAHI_DNS_FIELD_ANCOUNT) != 0)
 373             avahi_interface_send_packet_unicast(i, reply, a, port);
 374
 375         avahi_dns_packet_free(reply);
 376
 377     } else {
 378         gboolean unicast_response, flush_cache, auxiliary;
 379         AvahiDnsPacket *reply = NULL;
 380         AvahiRecord *r;
 381
 382         while ((r = avahi_record_list_next(s->record_list, &flush_cache, &unicast_response, &auxiliary))) {
 383
 384
 385             if (!avahi_interface_post_response(i, r, flush_cache, a, flush_cache && !auxiliary) && unicast_response) {
 386
 387                 append_aux_records_to_list(s, i, r, unicast_response);
 388
 389                 /* Due to some reasons the record has not been scheduled.
 390                  * The client requested an unicast response in that
 391                  * case. Therefore we prepare such a response */
 392
 393                 for (;;) {
 394
 395                     if (!reply) {
 396                         g_assert(p);
 397                         reply = avahi_dns_packet_new_reply(p, i->hardware->mtu, FALSE, FALSE);
 398                     }
 399
 400                     if (avahi_dns_packet_append_record(reply, r, flush_cache, 0)) {
 401
 402                         /* Appending this record succeeded, so incremeant
 403                          * the specific header field, and return to the caller */
 404
 405                         avahi_dns_packet_inc_field(reply, AVAHI_DNS_FIELD_ANCOUNT);
 406
 407                         break;
 408                     }
 409
 410                     if (avahi_dns_packet_get_field(reply, AVAHI_DNS_FIELD_ANCOUNT) == 0) {
 411                         guint size;
 412
 413                         /* The record is too large for one packet, so create a larger packet */
 414
 415                         avahi_dns_packet_free(reply);
 416                         size = avahi_record_get_estimate_size(r) + AVAHI_DNS_PACKET_HEADER_SIZE;
 417                         if (size > AVAHI_DNS_PACKET_MAX_SIZE)
 418                             size = AVAHI_DNS_PACKET_MAX_SIZE;
 419                         reply = avahi_dns_packet_new_reply(p, size, FALSE, TRUE);
 420
 421                         if (!avahi_dns_packet_append_record(reply, r, flush_cache, 0)) {
 422                             avahi_dns_packet_free(reply);
 423
 424                             gchar *t = avahi_record_to_string(r);
 425                             g_warning("Record [%s] too large, doesn't fit in any packet!", t);
 426                             g_free(t);
 427                             break;
 428                         } else
 429                             avahi_dns_packet_inc_field(reply, AVAHI_DNS_FIELD_ANCOUNT);
 430                     }
 431
 432                     /* Appending the record didn't succeeed, so let's send this packet, and create a new one */
 433                     avahi_interface_send_packet_unicast(i, reply, a, port);
 434                     avahi_dns_packet_free(reply);
 435                     reply = NULL;
 436                 }
 437             }
 438
 439             avahi_record_unref(r);
 440         }
 441
 442         if (reply) {
 443             if (avahi_dns_packet_get_field(reply, AVAHI_DNS_FIELD_ANCOUNT) != 0)
 444                 avahi_interface_send_packet_unicast(i, reply, a, port);
 445             avahi_dns_packet_free(reply);
 446         }
 447     }
 448
 449     avahi_record_list_flush(s->record_list);
 450 }
 451
 452 static void handle_query(AvahiServer *s, AvahiDnsPacket *p, AvahiInterface *i, const AvahiAddress *a, guint16 port, gboolean legacy_unicast) {
 453     guint n;
 454
 455     g_assert(s);
 456     g_assert(p);
 457     g_assert(i);
 458     g_assert(a);
 459
 460 /*     g_message("query"); */
 461
 462     g_assert(avahi_record_list_empty(s->record_list));
 463
 464     /* Handle the questions */
 465     for (n = avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_QDCOUNT); n > 0; n --) {
 466         AvahiKey *key;
 467         gboolean unicast_response = FALSE;
 468
 469         if (!(key = avahi_dns_packet_consume_key(p, &unicast_response))) {
 470             g_warning("Packet too short (1)");
 471             goto fail;
 472         }
 473
 474         avahi_query_scheduler_incoming(i->query_scheduler, key);
 475         avahi_server_prepare_matching_responses(s, i, key, unicast_response);
 476         avahi_key_unref(key);
 477     }
 478
 479     /* Known Answer Suppression */
 480     for (n = avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_ANCOUNT); n > 0; n --) {
 481         AvahiRecord *record;
 482         gboolean unique = FALSE;
 483
 484         if (!(record = avahi_dns_packet_consume_record(p, &unique))) {
 485             g_warning("Packet too short (2)");
 486             goto fail;
 487         }
 488
 489         if (handle_conflict(s, i, record, unique, a)) {
 490             avahi_response_scheduler_suppress(i->response_scheduler, record, a);
 491             avahi_record_list_drop(s->record_list, record);
 492         }
 493
 494         avahi_record_unref(record);
 495     }
 496
 497     /* Probe record */
 498     for (n = avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_NSCOUNT); n > 0; n --) {
 499         AvahiRecord *record;
 500         gboolean unique = FALSE;
 501
 502         if (!(record = avahi_dns_packet_consume_record(p, &unique))) {
 503             g_warning("Packet too short (3)");
 504             goto fail;
 505         }
 506
 507         if (record->key->type != AVAHI_DNS_TYPE_ANY)
 508             incoming_probe(s, record, i);
 509
 510         avahi_record_unref(record);
 511     }
 512
 513     if (!avahi_record_list_empty(s->record_list))
 514         avahi_server_generate_response(s, i, p, a, port, legacy_unicast);
 515
 516     return;
 517
 518 fail:
 519     avahi_record_list_flush(s->record_list);
 520
 521 }
 522
 523 static void handle_response(AvahiServer *s, AvahiDnsPacket *p, AvahiInterface *i, const AvahiAddress *a) {
 524     guint n;
 525
 526     g_assert(s);
 527     g_assert(p);
 528     g_assert(i);
 529     g_assert(a);
 530
 531 /*     g_message("response"); */
 532
 533     for (n = avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_ANCOUNT) +
 534              avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_ARCOUNT); n > 0; n--) {
 535         AvahiRecord *record;
 536         gboolean cache_flush = FALSE;
 537         gchar *txt;
 538
 539         if (!(record = avahi_dns_packet_consume_record(p, &cache_flush))) {
 540             g_warning("Packet too short (4)");
 541             break;
 542         }
 543
 544         if (record->key->type != AVAHI_DNS_TYPE_ANY) {
 545
 546             g_message("Handling response: %s", txt = avahi_record_to_string(record));
 547             g_free(txt);
 548
 549             if (handle_conflict(s, i, record, cache_flush, a)) {
 550                 avahi_cache_update(i->cache, record, cache_flush, a);
 551                 avahi_response_scheduler_incoming(i->response_scheduler, record, cache_flush);
 552             }
 553         }
 554
 555         avahi_record_unref(record);
 556     }
 557 }
 558
 559 static void dispatch_packet(AvahiServer *s, AvahiDnsPacket *p, struct sockaddr *sa, gint iface, gint ttl) {
 560     AvahiInterface *i;
 561     AvahiAddress a;
 562     guint16 port;
 563
 564     g_assert(s);
 565     g_assert(p);
 566     g_assert(sa);
 567     g_assert(iface > 0);
 568
 569     if (!(i = avahi_interface_monitor_get_interface(s->monitor, iface, sa->sa_family)) ||
 570         !avahi_interface_relevant(i)) {
 571         g_warning("Recieved packet from invalid interface.");
 572         return;
 573     }
 574
 575     g_message("new packet recieved on interface '%s.%i'.", i->hardware->name, i->protocol);
 576
 577     if (sa->sa_family == AF_INET6) {
 578         static const guint8 ipv4_in_ipv6[] = {
 579             0x00, 0x00, 0x00, 0x00,
 580             0x00, 0x00, 0x00, 0x00,
 581             0xFF, 0xFF, 0xFF, 0xFF };
 582
 583         /* This is an IPv4 address encapsulated in IPv6, so let's ignore it. */
 584
 585         if (memcmp(((struct sockaddr_in6*) sa)->sin6_addr.s6_addr, ipv4_in_ipv6, sizeof(ipv4_in_ipv6)) == 0)
 586             return;
 587     }
 588
 589     if (avahi_dns_packet_check_valid(p) < 0) {
 590         g_warning("Recieved invalid packet.");
 591         return;
 592     }
 593
 594     port = avahi_port_from_sockaddr(sa);
 595     avahi_address_from_sockaddr(sa, &a);
 596
 597     if (avahi_dns_packet_is_query(p)) {
 598         gboolean legacy_unicast = FALSE;
 599
 600         if (avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_ARCOUNT) != 0) {
 601             g_warning("Invalid query packet.");
 602             return;
 603         }
 604
 605         if (port != AVAHI_MDNS_PORT) {
 606             /* Legacy Unicast */
 607
 608             if ((avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_ANCOUNT) != 0 ||
 609                  avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_NSCOUNT) != 0)) {
 610                 g_warning("Invalid legacy unicast query packet.");
 611                 return;
 612             }
 613
 614             legacy_unicast = TRUE;
 615         }
 616
 617         handle_query(s, p, i, &a, port, legacy_unicast);
 618
 619         g_message("Handled query");
 620     } else {
 621
 622         if (port != AVAHI_MDNS_PORT) {
 623             g_warning("Recieved repsonse with invalid source port %u on interface '%s.%i'", port, i->hardware->name, i->protocol);
 624             return;
 625         }
 626
 627         if (ttl != 255) {
 628             g_warning("Recieved response with invalid TTL %u on interface '%s.%i'.", ttl, i->hardware->name, i->protocol);
 629             if (!s->ignore_bad_ttl)
 630                 return;
 631         }
 632
 633         if (avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_QDCOUNT) != 0 ||
 634             avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_ANCOUNT) == 0 ||
 635             avahi_dns_packet_get_field(p, AVAHI_DNS_FIELD_NSCOUNT) != 0) {
 636             g_warning("Invalid response packet.");
 637             return;
 638         }
 639
 640         handle_response(s, p, i, &a);
 641         g_message("Handled response");
 642     }
 643 }
 644
 645 static void work(AvahiServer *s) {
 646     struct sockaddr_in6 sa6;
 647     struct sockaddr_in sa;
 648     AvahiDnsPacket *p;
 649     gint iface = -1;
 650     guint8 ttl;
 651
 652     g_assert(s);
 653
 654     if (s->pollfd_ipv4.revents & G_IO_IN) {
 655         if ((p = avahi_recv_dns_packet_ipv4(s->fd_ipv4, &sa, &iface, &ttl))) {
 656             dispatch_packet(s, p, (struct sockaddr*) &sa, iface, ttl);
 657             avahi_dns_packet_free(p);
 658         }
 659     }
 660
 661     if (s->pollfd_ipv6.revents & G_IO_IN) {
 662         if ((p = avahi_recv_dns_packet_ipv6(s->fd_ipv6, &sa6, &iface, &ttl))) {
 663             dispatch_packet(s, p, (struct sockaddr*) &sa6, iface, ttl);
 664             avahi_dns_packet_free(p);
 665         }
 666     }
 667 }
 668
 669 static gboolean prepare_func(GSource *source, gint *timeout) {
 670     g_assert(source);
 671     g_assert(timeout);
 672
 673     *timeout = -1;
 674     return FALSE;
 675 }
 676
 677 static gboolean check_func(GSource *source) {
 678     AvahiServer* s;
 679     g_assert(source);
 680
 681     s = *((AvahiServer**) (((guint8*) source) + sizeof(GSource)));
 682     g_assert(s);
 683
 684     return (s->pollfd_ipv4.revents | s->pollfd_ipv6.revents) & (G_IO_IN | G_IO_HUP | G_IO_ERR);
 685 }
 686
 687 static gboolean dispatch_func(GSource *source, GSourceFunc callback, gpointer user_data) {
 688     AvahiServer* s;
 689     g_assert(source);
 690
 691     s = *((AvahiServer**) (((guint8*) source) + sizeof(GSource)));
 692     g_assert(s);
 693
 694     work(s);
 695     cleanup_dead(s);
 696
 697     return TRUE;
 698 }
 699
 700 static void add_default_entries(AvahiServer *s) {
 701     struct utsname utsname;
 702     AvahiAddress a;
 703     AvahiRecord *r;
 704
 705     g_assert(s);
 706
 707     return ;
 708
 709     /* Fill in HINFO rr */
 710     r = avahi_record_new_full(s->host_name_fqdn, AVAHI_DNS_CLASS_IN, AVAHI_DNS_TYPE_HINFO);
 711     uname(&utsname);
 712     r->data.hinfo.cpu = g_strdup(g_strup(utsname.machine));
 713     r->data.hinfo.os = g_strdup(g_strup(utsname.sysname));
 714     avahi_server_add(s, NULL, 0, AF_UNSPEC, AVAHI_ENTRY_UNIQUE, r);
 715     avahi_record_unref(r);
 716
 717     /* Add localhost entries */
 718     avahi_address_parse("127.0.0.1", AF_INET, &a);
 719     avahi_server_add_address(s, NULL, 0, AF_UNSPEC, AVAHI_ENTRY_NOPROBE|AVAHI_ENTRY_NOANNOUNCE, "localhost", &a);
 720
 721     avahi_address_parse("::1", AF_INET6, &a);
 722     avahi_server_add_address(s, NULL, 0, AF_UNSPEC, AVAHI_ENTRY_NOPROBE|AVAHI_ENTRY_NOANNOUNCE, "ip6-localhost", &a);
 723 }
 724
 725 AvahiServer *avahi_server_new(GMainContext *c) {
 726     AvahiServer *s;
 727
 728     static GSourceFuncs source_funcs = {
 729         prepare_func,
 730         check_func,
 731         dispatch_func,
 732         NULL,
 733         NULL,
 734         NULL
 735     };
 736
 737     s = g_new(AvahiServer, 1);
 738
 739     s->ignore_bad_ttl = FALSE;
 740     s->need_entry_cleanup = s->need_group_cleanup = FALSE;
 741
 742     s->fd_ipv4 = avahi_open_socket_ipv4();
 743     s->fd_ipv6 = -1 /* avahi_open_socket_ipv6() */ ;
 744
 745     if (s->fd_ipv6 < 0 && s->fd_ipv4 < 0) {
 746         g_critical("Failed to create IP sockets.\n");
 747         g_free(s);
 748         return NULL;
 749     }
 750
 751     if (s->fd_ipv4 < 0)
 752         g_message("Failed to create IPv4 socket, proceeding in IPv6 only mode");
 753     else if (s->fd_ipv6 < 0)
 754         g_message("Failed to create IPv6 socket, proceeding in IPv4 only mode");
 755
 756     if (c)
 757         g_main_context_ref(s->context = c);
 758     else
 759         s->context = g_main_context_default();
 760
 761     AVAHI_LLIST_HEAD_INIT(AvahiEntry, s->entries);
 762     s->entries_by_key = g_hash_table_new((GHashFunc) avahi_key_hash, (GEqualFunc) avahi_key_equal);
 763     AVAHI_LLIST_HEAD_INIT(AvahiGroup, s->groups);
 764
 765     AVAHI_LLIST_HEAD_INIT(AvahiSubscription, s->subscriptions);
 766     s->subscription_hashtable = g_hash_table_new((GHashFunc) avahi_key_hash, (GEqualFunc) avahi_key_equal);
 767
 768     /* Get host name */
 769     s->host_name = avahi_get_host_name();
 770     s->host_name[strcspn(s->host_name, ".")] = 0;
 771
 772     s->domain = avahi_normalize_name("local.");
 773
 774     s->host_name_fqdn = g_strdup_printf("%s.%s", s->host_name, s->domain);
 775
 776     s->record_list = avahi_record_list_new();
 777
 778     s->time_event_queue = avahi_time_event_queue_new(s->context, G_PRIORITY_DEFAULT+10); /* Slightly less priority than the FDs */
 779     s->monitor = avahi_interface_monitor_new(s);
 780     avahi_interface_monitor_sync(s->monitor);
 781     add_default_entries(s);
 782
 783     /* Prepare IO source registration */
 784     s->source = g_source_new(&source_funcs, sizeof(GSource) + sizeof(AvahiServer*));
 785     *((AvahiServer**) (((guint8*) s->source) + sizeof(GSource))) = s;
 786
 787     memset(&s->pollfd_ipv4, 0, sizeof(s->pollfd_ipv4));
 788     s->pollfd_ipv4.fd = s->fd_ipv4;
 789     s->pollfd_ipv4.events = G_IO_IN|G_IO_ERR|G_IO_HUP;
 790     g_source_add_poll(s->source, &s->pollfd_ipv4);
 791
 792     memset(&s->pollfd_ipv6, 0, sizeof(s->pollfd_ipv6));
 793     s->pollfd_ipv6.fd = s->fd_ipv6;
 794     s->pollfd_ipv6.events = G_IO_IN|G_IO_ERR|G_IO_HUP;
 795     g_source_add_poll(s->source, &s->pollfd_ipv6);
 796
 797     g_source_attach(s->source, s->context);
 798
 799     return s;
 800 }
 801
 802 void avahi_server_free(AvahiServer* s) {
 803     g_assert(s);
 804
 805     while(s->entries)
 806         free_entry(s, s->entries);
 807
 808     avahi_interface_monitor_free(s->monitor);
 809
 810     while (s->groups)
 811         free_group(s, s->groups);
 812
 813     while (s->subscriptions)
 814         avahi_subscription_free(s->subscriptions);
 815     g_hash_table_destroy(s->subscription_hashtable);
 816
 817     g_hash_table_destroy(s->entries_by_key);
 818
 819     avahi_time_event_queue_free(s->time_event_queue);
 820
 821     avahi_record_list_free(s->record_list);
 822
 823     if (s->fd_ipv4 >= 0)
 824         close(s->fd_ipv4);
 825     if (s->fd_ipv6 >= 0)
 826         close(s->fd_ipv6);
 827
 828     g_free(s->host_name);
 829     g_free(s->domain);
 830     g_free(s->host_name_fqdn);
 831
 832     g_source_destroy(s->source);
 833     g_source_unref(s->source);
 834     g_main_context_unref(s->context);
 835
 836     g_free(s);
 837 }
 838
 839 void avahi_server_add(
 840     AvahiServer *s,
 841     AvahiEntryGroup *g,
 842     gint interface,
 843     guchar protocol,
 844     AvahiEntryFlags flags,
 845     AvahiRecord *r) {
 846
 847     AvahiEntry *e, *t;
 848     g_assert(s);
 849     g_assert(r);
 850
 851     g_assert(r->key->type != AVAHI_DNS_TYPE_ANY);
 852
 853     e = g_new(AvahiEntry, 1);
 854     e->server = s;
 855     e->record = avahi_record_ref(r);
 856     e->group = g;
 857     e->interface = interface;
 858     e->protocol = protocol;
 859     e->flags = flags;
 860     e->dead = FALSE;
 861
 862     AVAHI_LLIST_HEAD_INIT(AvahiAnnouncement, e->announcements);
 863
 864     AVAHI_LLIST_PREPEND(AvahiEntry, entries, s->entries, e);
 865
 866     /* Insert into hash table indexed by name */
 867     t = g_hash_table_lookup(s->entries_by_key, e->record->key);
 868     AVAHI_LLIST_PREPEND(AvahiEntry, by_key, t, e);
 869     g_hash_table_replace(s->entries_by_key, e->record->key, t);
 870
 871     /* Insert into group list */
 872     if (g)
 873         AVAHI_LLIST_PREPEND(AvahiEntry, by_group, g->entries, e);
 874
 875     avahi_announce_entry(s, e);
 876 }
 877 const AvahiRecord *avahi_server_iterate(AvahiServer *s, AvahiEntryGroup *g, void **state) {
 878     AvahiEntry **e = (AvahiEntry**) state;
 879     g_assert(s);
 880     g_assert(e);
 881
 882     if (!*e)
 883         *e = g ? g->entries : s->entries;
 884
 885     while (*e && (*e)->dead)
 886         *e = g ? (*e)->by_group_next : (*e)->entries_next;
 887
 888     if (!*e)
 889         return NULL;
 890
 891     return avahi_record_ref((*e)->record);
 892 }
 893
 894 void avahi_server_dump(AvahiServer *s, FILE *f) {
 895     AvahiEntry *e;
 896     g_assert(s);
 897     g_assert(f);
 898
 899     fprintf(f, "\n;;; ZONE DUMP FOLLOWS ;;;\n");
 900
 901     for (e = s->entries; e; e = e->entries_next) {
 902         gchar *t;
 903
 904         if (e->dead)
 905             continue;
 906
 907         t = avahi_record_to_string(e->record);
 908         fprintf(f, "%s ; iface=%i proto=%i\n", t, e->interface, e->protocol);
 909         g_free(t);
 910     }
 911
 912     avahi_dump_caches(s->monitor, f);
 913 }
 914
 915 void avahi_server_add_ptr(
 916     AvahiServer *s,
 917     AvahiEntryGroup *g,
 918     gint interface,
 919     guchar protocol,
 920     AvahiEntryFlags flags,
 921     const gchar *name,
 922     const gchar *dest) {
 923
 924     AvahiRecord *r;
 925
 926     g_assert(dest);
 927
 928     r = avahi_record_new_full(name ? name : s->host_name_fqdn, AVAHI_DNS_CLASS_IN, AVAHI_DNS_TYPE_PTR);
 929     r->data.ptr.name = avahi_normalize_name(dest);
 930     avahi_server_add(s, g, interface, protocol, flags, r);
 931     avahi_record_unref(r);
 932 }
 933
 934 void avahi_server_add_address(
 935     AvahiServer *s,
 936     AvahiEntryGroup *g,
 937     gint interface,
 938     guchar protocol,
 939     AvahiEntryFlags flags,
 940     const gchar *name,
 941     AvahiAddress *a) {
 942
 943     gchar *n = NULL;
 944     g_assert(s);
 945     g_assert(a);
 946
 947     name = name ? (n = avahi_normalize_name(name)) : s->host_name_fqdn;
 948
 949     if (a->family == AF_INET) {
 950         gchar *reverse;
 951         AvahiRecord  *r;
 952
 953         r = avahi_record_new_full(name, AVAHI_DNS_CLASS_IN, AVAHI_DNS_TYPE_A);
 954         r->data.a.address = a->data.ipv4;
 955         avahi_server_add(s, g, interface, protocol, flags | AVAHI_ENTRY_UNIQUE, r);
 956         avahi_record_unref(r);
 957
 958         reverse = avahi_reverse_lookup_name_ipv4(&a->data.ipv4);
 959         avahi_server_add_ptr(s, g, interface, protocol, flags | AVAHI_ENTRY_UNIQUE, reverse, name);
 960         g_free(reverse);
 961
 962     } else {
 963         gchar *reverse;
 964         AvahiRecord *r;
 965
 966         r = avahi_record_new_full(name, AVAHI_DNS_CLASS_IN, AVAHI_DNS_TYPE_AAAA);
 967         r->data.aaaa.address = a->data.ipv6;
 968         avahi_server_add(s, g, interface, protocol, flags | AVAHI_ENTRY_UNIQUE, r);
 969         avahi_record_unref(r);
 970
 971         reverse = avahi_reverse_lookup_name_ipv6_arpa(&a->data.ipv6);
 972         avahi_server_add_ptr(s, g, interface, protocol, flags | AVAHI_ENTRY_UNIQUE, reverse, name);
 973         g_free(reverse);
 974
 975         reverse = avahi_reverse_lookup_name_ipv6_int(&a->data.ipv6);
 976         avahi_server_add_ptr(s, g, interface, protocol, flags | AVAHI_ENTRY_UNIQUE, reverse, name);
 977         g_free(reverse);
 978     }
 979
 980     g_free(n);
 981 }
 982
 983 void avahi_server_add_text_strlst(
 984     AvahiServer *s,
 985     AvahiEntryGroup *g,
 986     gint interface,
 987     guchar protocol,
 988     AvahiEntryFlags flags,
 989     const gchar *name,
 990     AvahiStringList *strlst) {
 991
 992     AvahiRecord *r;
 993
 994     g_assert(s);
 995
 996     r = avahi_record_new_full(name ? name : s->host_name_fqdn, AVAHI_DNS_CLASS_IN, AVAHI_DNS_TYPE_TXT);
 997     r->data.txt.string_list = strlst;
 998     avahi_server_add(s, g, interface, protocol, flags, r);
 999     avahi_record_unref(r);
1000 }
1001
1002 void avahi_server_add_text_va(
1003     AvahiServer *s,
1004     AvahiEntryGroup *g,
1005     gint interface,
1006     guchar protocol,
1007     AvahiEntryFlags flags,
1008     const gchar *name,
1009     va_list va) {
1010
1011     g_assert(s);
1012
1013     avahi_server_add_text_strlst(s, g, interface, protocol, flags, name, avahi_string_list_new_va(va));
1014 }
1015
1016 void avahi_server_add_text(
1017     AvahiServer *s,
1018     AvahiEntryGroup *g,
1019     gint interface,
1020     guchar protocol,
1021     AvahiEntryFlags flags,
1022     const gchar *name,
1023     ...) {
1024
1025     va_list va;
1026
1027     g_assert(s);
1028
1029     va_start(va, name);
1030     avahi_server_add_text_va(s, g, interface, protocol, flags, name, va);
1031     va_end(va);
1032 }
1033
1034 static void escape_service_name(gchar *d, guint size, const gchar *s) {
1035     g_assert(d);
1036     g_assert(size);
1037     g_assert(s);
1038
1039     while (*s && size >= 2) {
1040         if (*s == '.' || *s == '\\') {
1041             if (size < 3)
1042                 break;
1043
1044             *(d++) = '\\';
1045             size--;
1046         }
1047
1048         *(d++) = *(s++);
1049         size--;
1050     }
1051
1052     g_assert(size > 0);
1053     *(d++) = 0;
1054 }
1055
1056 void avahi_server_add_service_strlst(
1057     AvahiServer *s,
1058     AvahiEntryGroup *g,
1059     gint interface,
1060     guchar protocol,
1061     const gchar *type,
1062     const gchar *name,
1063     const gchar *domain,
1064     const gchar *host,
1065     guint16 port,
1066     AvahiStringList *strlst) {
1067
1068     gchar ptr_name[256], svc_name[256], ename[64], enum_ptr[256];
1069     AvahiRecord *r;
1070
1071     g_assert(s);
1072     g_assert(type);
1073     g_assert(name);
1074
1075     escape_service_name(ename, sizeof(ename), name);
1076
1077     if (domain) {
1078         while (domain[0] == '.')
1079             domain++;
1080     } else
1081         domain = "local";
1082
1083     if (!host)
1084         host = s->host_name_fqdn;
1085
1086     snprintf(ptr_name, sizeof(ptr_name), "%s.%s", type, domain);
1087     snprintf(svc_name, sizeof(svc_name), "%s.%s.%s", ename, type, domain);
1088
1089     avahi_server_add_ptr(s, g, interface, protocol, AVAHI_ENTRY_NULL, ptr_name, svc_name);
1090
1091     r = avahi_record_new_full(svc_name, AVAHI_DNS_CLASS_IN, AVAHI_DNS_TYPE_SRV);
1092     r->data.srv.priority = 0;
1093     r->data.srv.weight = 0;
1094     r->data.srv.port = port;
1095     r->data.srv.name = avahi_normalize_name(host);
1096     avahi_server_add(s, g, interface, protocol, AVAHI_ENTRY_UNIQUE, r);
1097     avahi_record_unref(r);
1098
1099     avahi_server_add_text_strlst(s, g, interface, protocol, AVAHI_ENTRY_UNIQUE, svc_name, strlst);
1100
1101     snprintf(enum_ptr, sizeof(enum_ptr), "_services._dns-sd._udp.%s", domain);
1102     avahi_server_add_ptr(s, g, interface, protocol, AVAHI_ENTRY_NULL, enum_ptr, ptr_name);
1103 }
1104
1105 void avahi_server_add_service_va(
1106     AvahiServer *s,
1107     AvahiEntryGroup *g,
1108     gint interface,
1109     guchar protocol,
1110     const gchar *type,
1111     const gchar *name,
1112     const gchar *domain,
1113     const gchar *host,
1114     guint16 port,
1115     va_list va){
1116
1117     g_assert(s);
1118     g_assert(type);
1119     g_assert(name);
1120
1121     avahi_server_add_service_strlst(s, g, interface, protocol, type, name, domain, host, port, avahi_string_list_new_va(va));
1122 }
1123
1124 void avahi_server_add_service(
1125     AvahiServer *s,
1126     AvahiEntryGroup *g,
1127     gint interface,
1128     guchar protocol,
1129     const gchar *type,
1130     const gchar *name,
1131     const gchar *domain,
1132     const gchar *host,
1133     guint16 port,
1134     ... ){
1135
1136     va_list va;
1137
1138     g_assert(s);
1139     g_assert(type);
1140     g_assert(name);
1141
1142     va_start(va, port);
1143     avahi_server_add_service_va(s, g, interface, protocol, type, name, domain, host, port, va);
1144     va_end(va);
1145 }
1146
1147 static void post_query_callback(AvahiInterfaceMonitor *m, AvahiInterface *i, gpointer userdata) {
1148     AvahiKey *k = userdata;
1149
1150     g_assert(m);
1151     g_assert(i);
1152     g_assert(k);
1153
1154     avahi_interface_post_query(i, k, FALSE);
1155 }
1156
1157 void avahi_server_post_query(AvahiServer *s, gint interface, guchar protocol, AvahiKey *key) {
1158     g_assert(s);
1159     g_assert(key);
1160
1161     avahi_interface_monitor_walk(s->monitor, interface, protocol, post_query_callback, key);
1162 }
1163
1164 void avahi_entry_group_change_state(AvahiEntryGroup *g, AvahiEntryGroupState state) {
1165     g_assert(g);
1166
1167     if (g->state == state)
1168         return;
1169
1170     g->state = state;
1171
1172     if (g->callback) {
1173         g->callback(g->server, g, state, g->userdata);
1174         return;
1175     }
1176 }
1177
1178 AvahiEntryGroup *avahi_entry_group_new(AvahiServer *s, AvahiEntryGroupCallback callback, gpointer userdata) {
1179     AvahiEntryGroup *g;
1180
1181     g_assert(s);
1182
1183     g = g_new(AvahiEntryGroup, 1);
1184     g->server = s;
1185     g->callback = callback;
1186     g->userdata = userdata;
1187     g->dead = FALSE;
1188     g->state = AVAHI_ENTRY_GROUP_UNCOMMITED;
1189     g->n_probing = 0;
1190     AVAHI_LLIST_HEAD_INIT(AvahiEntry, g->entries);
1191
1192     AVAHI_LLIST_PREPEND(AvahiEntryGroup, groups, s->groups, g);
1193     return g;
1194 }
1195
1196 void avahi_entry_group_free(AvahiEntryGroup *g) {
1197     g_assert(g);
1198     g_assert(g->server);
1199
1200     g->dead = TRUE;
1201     g->server->need_group_cleanup = TRUE;
1202 }
1203
1204 void avahi_entry_group_commit(AvahiEntryGroup *g) {
1205     g_assert(g);
1206     g_assert(!g->dead);
1207
1208     if (g->state != AVAHI_ENTRY_GROUP_UNCOMMITED)
1209         return;
1210
1211     avahi_entry_group_change_state(g, AVAHI_ENTRY_GROUP_REGISTERING);
1212     avahi_announce_group(g->server, g);
1213     avahi_entry_group_check_probed(g, FALSE);
1214 }
1215
1216 gboolean avahi_entry_commited(AvahiEntry *e) {
1217     g_assert(e);
1218     g_assert(!e->dead);
1219
1220     return !e->group ||
1221         e->group->state == AVAHI_ENTRY_GROUP_REGISTERING ||
1222         e->group->state == AVAHI_ENTRY_GROUP_ESTABLISHED;
1223 }
1224
1225 AvahiEntryGroupState avahi_entry_group_get_state(AvahiEntryGroup *g) {
1226     g_assert(g);
1227     g_assert(!g->dead);
1228
1229     return g->state;
1230 }
1231
1232 const gchar* avahi_server_get_domain(AvahiServer *s) {
1233     g_assert(s);
1234
1235     return s->domain;
1236 }
1237
1238 const gchar* avahi_server_get_host_name(AvahiServer *s) {
1239     g_assert(s);
1240
1241     return s->host_name_fqdn;
1242 }