git.meshlink.io Git - catta/blob - server.c

   1 #include <sys/socket.h>
   2 #include <arpa/inet.h>
   3 #include <string.h>
   4 #include <sys/utsname.h>
   5 #include <unistd.h>
   6
   7 #include "server.h"
   8 #include "util.h"
   9 #include "iface.h"
  10 #include "socket.h"
  11 #include "subscribe.h"
  12
  13 static void handle_query_key(flxServer *s, flxKey *k, flxInterface *i, const flxAddress *a) {
  14     flxServerEntry *e;
  15     gchar *txt;
  16
  17     g_assert(s);
  18     g_assert(k);
  19     g_assert(i);
  20     g_assert(a);
  21
  22     g_message("Handling query: %s", txt = flx_key_to_string(k));
  23     g_free(txt);
  24
  25     flx_packet_scheduler_incoming_query(i->scheduler, k);
  26
  27     if (k->type == FLX_DNS_TYPE_ANY) {
  28
  29         /* Handle ANY query */
  30
  31         for (e = s->entries; e; e = e->entry_next)
  32             if (flx_key_pattern_match(k, e->record->key))
  33                 if (flx_interface_match(i, e->interface, e->protocol))
  34                     flx_interface_post_response(i, a, e->record, FALSE);
  35     } else {
  36
  37         /* Handle all other queries */
  38
  39         for (e = g_hash_table_lookup(s->rrset_by_key, k); e; e = e->by_key_next)
  40             if (flx_interface_match(i, e->interface, e->protocol))
  41                 flx_interface_post_response(i, a, e->record, FALSE);
  42     }
  43 }
  44
  45 static void handle_query(flxServer *s, flxDnsPacket *p, flxInterface *i, const flxAddress *a) {
  46     guint n;
  47
  48     g_assert(s);
  49     g_assert(p);
  50     g_assert(i);
  51     g_assert(a);
  52
  53     for (n = flx_dns_packet_get_field(p, DNS_FIELD_QDCOUNT); n > 0; n --) {
  54         flxKey *key;
  55
  56         if (!(key = flx_dns_packet_consume_key(p))) {
  57             g_warning("Packet too short");
  58             return;
  59         }
  60
  61         handle_query_key(s, key, i, a);
  62         flx_key_unref(key);
  63     }
  64
  65     /* Known Answer Suppresion */
  66     for (n = flx_dns_packet_get_field(p, DNS_FIELD_ANCOUNT); n > 0; n --) {
  67         flxRecord *record;
  68         gboolean unique = FALSE;
  69
  70         if (!(record = flx_dns_packet_consume_record(p, &unique))) {
  71             g_warning("Packet too short (2)");
  72             return;
  73         }
  74
  75         flx_packet_scheduler_incoming_known_answer(i->scheduler, record, a);
  76         flx_record_unref(record);
  77     }
  78 }
  79
  80 static void handle_response(flxServer *s, flxDnsPacket *p, flxInterface *i, const flxAddress *a) {
  81     guint n;
  82
  83     g_assert(s);
  84     g_assert(p);
  85     g_assert(i);
  86     g_assert(a);
  87
  88     for (n = flx_dns_packet_get_field(p, DNS_FIELD_ANCOUNT) +
  89              flx_dns_packet_get_field(p, DNS_FIELD_ARCOUNT); n > 0; n--) {
  90         flxRecord *record;
  91         gboolean cache_flush = FALSE;
  92         gchar *txt;
  93
  94         if (!(record = flx_dns_packet_consume_record(p, &cache_flush))) {
  95             g_warning("Packet too short");
  96             return;
  97         }
  98
  99         if (record->key->type != FLX_DNS_TYPE_ANY) {
 100             g_message("Handling response: %s", txt = flx_record_to_string(record));
 101             g_free(txt);
 102
 103             flx_cache_update(i->cache, record, cache_flush, a);
 104
 105             flx_packet_scheduler_incoming_response(i->scheduler, record);
 106             flx_record_unref(record);
 107         }
 108     }
 109 }
 110
 111 static void dispatch_packet(flxServer *s, flxDnsPacket *p, struct sockaddr *sa, gint iface, gint ttl) {
 112     flxInterface *i;
 113     flxAddress a;
 114
 115     g_assert(s);
 116     g_assert(p);
 117     g_assert(sa);
 118     g_assert(iface > 0);
 119
 120     g_message("new packet recieved.");
 121
 122     if (!(i = flx_interface_monitor_get_interface(s->monitor, iface, sa->sa_family))) {
 123         g_warning("Recieved packet from invalid interface.");
 124         return;
 125     }
 126
 127     if (ttl != 255) {
 128         g_warning("Recieved packet with invalid TTL on interface '%s.%i'.", i->hardware->name, i->protocol);
 129         return;
 130     }
 131
 132     if (sa->sa_family == AF_INET6) {
 133         static const unsigned char ipv4_in_ipv6[] = {
 134             0x00, 0x00, 0x00, 0x00,
 135             0x00, 0x00, 0x00, 0x00,
 136             0xFF, 0xFF, 0xFF, 0xFF };
 137
 138         if (memcmp(((struct sockaddr_in6*) sa)->sin6_addr.s6_addr, ipv4_in_ipv6, sizeof(ipv4_in_ipv6)) == 0) {
 139
 140             /* This is an IPv4 address encapsulated in IPv6, so let's ignore it. */
 141             return;
 142         }
 143     }
 144
 145     if (flx_dns_packet_check_valid(p) < 0) {
 146         g_warning("Recieved invalid packet.");
 147         return;
 148     }
 149
 150     flx_address_from_sockaddr(sa, &a);
 151
 152     if (flx_dns_packet_is_query(p)) {
 153
 154         if (flx_dns_packet_get_field(p, DNS_FIELD_QDCOUNT) == 0 ||
 155             flx_dns_packet_get_field(p, DNS_FIELD_ARCOUNT) != 0 ||
 156             flx_dns_packet_get_field(p, DNS_FIELD_NSCOUNT) != 0) {
 157             g_warning("Invalid query packet.");
 158             return;
 159         }
 160
 161         handle_query(s, p, i, &a);
 162         g_message("Handled query");
 163     } else {
 164         if (flx_dns_packet_get_field(p, DNS_FIELD_QDCOUNT) != 0 ||
 165             flx_dns_packet_get_field(p, DNS_FIELD_ANCOUNT) == 0 ||
 166             flx_dns_packet_get_field(p, DNS_FIELD_NSCOUNT) != 0) {
 167             g_warning("Invalid response packet.");
 168             return;
 169         }
 170
 171         handle_response(s, p, i, &a);
 172         g_message("Handled response");
 173     }
 174 }
 175
 176 static gboolean work(flxServer *s) {
 177     struct sockaddr_in6 sa6;
 178     struct sockaddr_in sa;
 179     flxDnsPacket *p;
 180     gint iface = -1;
 181     guint8 ttl;
 182
 183     g_assert(s);
 184
 185     if (s->pollfd_ipv4.revents & G_IO_IN) {
 186         if ((p = flx_recv_dns_packet_ipv4(s->fd_ipv4, &sa, &iface, &ttl))) {
 187             dispatch_packet(s, p, (struct sockaddr*) &sa, iface, ttl);
 188             flx_dns_packet_free(p);
 189         }
 190     }
 191
 192     if (s->pollfd_ipv6.revents & G_IO_IN) {
 193         if ((p = flx_recv_dns_packet_ipv6(s->fd_ipv6, &sa6, &iface, &ttl))) {
 194             dispatch_packet(s, p, (struct sockaddr*) &sa6, iface, ttl);
 195             flx_dns_packet_free(p);
 196         }
 197     }
 198
 199     return TRUE;
 200 }
 201
 202 static gboolean prepare_func(GSource *source, gint *timeout) {
 203     g_assert(source);
 204     g_assert(timeout);
 205
 206     *timeout = -1;
 207     return FALSE;
 208 }
 209
 210 static gboolean check_func(GSource *source) {
 211     flxServer* s;
 212     g_assert(source);
 213
 214     s = *((flxServer**) (((guint8*) source) + sizeof(GSource)));
 215     g_assert(s);
 216
 217     return (s->pollfd_ipv4.revents | s->pollfd_ipv6.revents) & (G_IO_IN | G_IO_HUP | G_IO_ERR);
 218 }
 219
 220 static gboolean dispatch_func(GSource *source, GSourceFunc callback, gpointer user_data) {
 221     flxServer* s;
 222     g_assert(source);
 223
 224     s = *((flxServer**) (((guint8*) source) + sizeof(GSource)));
 225     g_assert(s);
 226
 227     return work(s);
 228 }
 229
 230 static void add_default_entries(flxServer *s) {
 231     gint length = 0;
 232     struct utsname utsname;
 233     gchar *hinfo;
 234     flxAddress a;
 235
 236     g_assert(s);
 237
 238     /* Fill in HINFO rr */
 239     uname(&utsname);
 240     hinfo = g_strdup_printf("%c%s%c%s%n",
 241                             strlen(utsname.machine), g_strup(utsname.machine),
 242                             strlen(utsname.sysname), g_strup(utsname.sysname),
 243                             &length);
 244
 245     flx_server_add_full(s, 0, 0, AF_UNSPEC, TRUE,
 246                         s->hostname, FLX_DNS_CLASS_IN, FLX_DNS_TYPE_HINFO, hinfo, length, FLX_DEFAULT_TTL);
 247
 248     g_free(hinfo);
 249
 250     /* Add localhost entries */
 251     flx_address_parse("127.0.0.1", AF_INET, &a);
 252     flx_server_add_address(s, 0, 0, AF_UNSPEC, TRUE, "localhost", &a);
 253
 254     flx_address_parse("::1", AF_INET6, &a);
 255     flx_server_add_address(s, 0, 0, AF_UNSPEC, TRUE, "ip6-localhost", &a);
 256 }
 257
 258 flxServer *flx_server_new(GMainContext *c) {
 259     gchar *hn, *e;
 260     flxServer *s;
 261
 262     static GSourceFuncs source_funcs = {
 263         prepare_func,
 264         check_func,
 265         dispatch_func,
 266         NULL,
 267         NULL,
 268         NULL
 269     };
 270
 271     s = g_new(flxServer, 1);
 272
 273     s->fd_ipv4 = flx_open_socket_ipv4();
 274     s->fd_ipv6 = flx_open_socket_ipv6();
 275
 276     if (s->fd_ipv6 < 0 && s->fd_ipv4 < 0) {
 277         g_critical("Failed to create sockets.\n");
 278         g_free(s);
 279         return NULL;
 280     }
 281
 282     if (s->fd_ipv4 < 0)
 283         g_message("Failed to create IPv4 socket, proceeding in IPv6 only mode");
 284     else if (s->fd_ipv6 < 0)
 285         g_message("Failed to create IPv6 socket, proceeding in IPv4 only mode");
 286
 287     if (c)
 288         g_main_context_ref(s->context = c);
 289     else
 290         s->context = g_main_context_default();
 291
 292     s->current_id = 1;
 293
 294     FLX_LLIST_HEAD_INIT(flxServerEntry, s->entries);
 295     s->rrset_by_id = g_hash_table_new(g_int_hash, g_int_equal);
 296     s->rrset_by_key = g_hash_table_new((GHashFunc) flx_key_hash, (GEqualFunc) flx_key_equal);
 297
 298     FLX_LLIST_HEAD_INIT(flxSubscription, s->subscriptions);
 299     s->subscription_hashtable = g_hash_table_new((GHashFunc) flx_key_hash, (GEqualFunc) flx_key_equal);
 300
 301     s->monitor = flx_interface_monitor_new(s);
 302     s->time_event_queue = flx_time_event_queue_new(s->context);
 303
 304     /* Get host name */
 305     hn = flx_get_host_name();
 306     if ((e = strchr(hn, '.')))
 307         *e = 0;
 308
 309     s->hostname = g_strdup_printf("%s.local.", hn);
 310     g_free(hn);
 311
 312     add_default_entries(s);
 313
 314     s->source = g_source_new(&source_funcs, sizeof(GSource) + sizeof(flxServer*));
 315     *((flxServer**) (((guint8*) s->source) + sizeof(GSource))) = s;
 316
 317     memset(&s->pollfd_ipv4, 0, sizeof(s->pollfd_ipv4));
 318     s->pollfd_ipv4.fd = s->fd_ipv4;
 319     s->pollfd_ipv4.events = G_IO_IN|G_IO_ERR|G_IO_HUP;
 320     g_source_add_poll(s->source, &s->pollfd_ipv4);
 321
 322     memset(&s->pollfd_ipv6, 0, sizeof(s->pollfd_ipv6));
 323     s->pollfd_ipv6.fd = s->fd_ipv6;
 324     s->pollfd_ipv6.events = G_IO_IN|G_IO_ERR|G_IO_HUP;
 325     g_source_add_poll(s->source, &s->pollfd_ipv6);
 326
 327     g_source_attach(s->source, s->context);
 328
 329     return s;
 330 }
 331
 332 void flx_server_free(flxServer* s) {
 333     g_assert(s);
 334
 335     flx_interface_monitor_free(s->monitor);
 336
 337     flx_server_remove(s, 0);
 338
 339     while (s->subscriptions)
 340         flx_subscription_free(s->subscriptions);
 341     g_hash_table_destroy(s->subscription_hashtable);
 342
 343     g_hash_table_destroy(s->rrset_by_id);
 344     g_hash_table_destroy(s->rrset_by_key);
 345
 346     flx_time_event_queue_free(s->time_event_queue);
 347
 348     if (s->fd_ipv4 >= 0)
 349         close(s->fd_ipv4);
 350     if (s->fd_ipv6 >= 0)
 351         close(s->fd_ipv6);
 352
 353     g_free(s->hostname);
 354
 355     g_source_destroy(s->source);
 356     g_source_unref(s->source);
 357     g_main_context_unref(s->context);
 358
 359     g_free(s);
 360 }
 361
 362 gint flx_server_get_next_id(flxServer *s) {
 363     g_assert(s);
 364
 365     return s->current_id++;
 366 }
 367
 368 void flx_server_add(
 369     flxServer *s,
 370     gint id,
 371     gint interface,
 372     guchar protocol,
 373     gboolean unique,
 374     flxRecord *r) {
 375
 376     flxServerEntry *e, *t;
 377     g_assert(s);
 378     g_assert(r);
 379
 380     g_assert(r->key->type != FLX_DNS_TYPE_ANY);
 381
 382     e = g_new(flxServerEntry, 1);
 383     e->record = flx_record_ref(r);
 384     e->id = id;
 385     e->interface = interface;
 386     e->protocol = protocol;
 387     e->unique = unique;
 388
 389     FLX_LLIST_HEAD_INIT(flxAnnouncement, e->announcements);
 390
 391     FLX_LLIST_PREPEND(flxServerEntry, entry, s->entries, e);
 392
 393     /* Insert into hash table indexed by id */
 394     t = g_hash_table_lookup(s->rrset_by_id, &e->id);
 395     FLX_LLIST_PREPEND(flxServerEntry, by_id, t, e);
 396     g_hash_table_replace(s->rrset_by_id, &e->id, t);
 397
 398     /* Insert into hash table indexed by name */
 399     t = g_hash_table_lookup(s->rrset_by_key, e->record->key);
 400     FLX_LLIST_PREPEND(flxServerEntry, by_key, t, e);
 401     g_hash_table_replace(s->rrset_by_key, e->record->key, t);
 402
 403     flx_announce_entry(s, e);
 404 }
 405
 406 void flx_server_add_full(
 407     flxServer *s,
 408     gint id,
 409     gint interface,
 410     guchar protocol,
 411     gboolean unique,
 412     const gchar *name,
 413     guint16 class,
 414     guint16 type,
 415     gconstpointer data,
 416     guint size,
 417     guint32 ttl) {
 418
 419     flxRecord *r;
 420     g_assert(s);
 421     g_assert(data);
 422     g_assert(size);
 423
 424     r = flx_record_new_full(name ? name : s->hostname, class, type, data, size, ttl);
 425     flx_server_add(s, id, interface, protocol, unique, r);
 426     flx_record_unref(r);
 427 }
 428
 429 const flxRecord *flx_server_iterate(flxServer *s, gint id, void **state) {
 430     flxServerEntry **e = (flxServerEntry**) state;
 431     g_assert(s);
 432     g_assert(e);
 433
 434     if (e)
 435         *e = id > 0 ? (*e)->by_id_next : (*e)->entry_next;
 436     else
 437         *e = id > 0 ? g_hash_table_lookup(s->rrset_by_id, &id) : s->entries;
 438
 439     if (!*e)
 440         return NULL;
 441
 442     return flx_record_ref((*e)->record);
 443 }
 444
 445 static void free_entry(flxServer*s, flxServerEntry *e) {
 446     flxServerEntry *t;
 447
 448     g_assert(e);
 449
 450     flx_goodbye_entry(s, e, TRUE);
 451
 452     /* Remove from linked list */
 453     FLX_LLIST_REMOVE(flxServerEntry, entry, s->entries, e);
 454
 455     /* Remove from hash table indexed by id */
 456     t = g_hash_table_lookup(s->rrset_by_id, &e->id);
 457     FLX_LLIST_REMOVE(flxServerEntry, by_id, t, e);
 458     if (t)
 459         g_hash_table_replace(s->rrset_by_id, &t->id, t);
 460     else
 461         g_hash_table_remove(s->rrset_by_id, &e->id);
 462
 463     /* Remove from hash table indexed by name */
 464     t = g_hash_table_lookup(s->rrset_by_key, e->record->key);
 465     FLX_LLIST_REMOVE(flxServerEntry, by_key, t, e);
 466     if (t)
 467         g_hash_table_replace(s->rrset_by_key, t->record->key, t);
 468     else
 469         g_hash_table_remove(s->rrset_by_key, e->record->key);
 470
 471     flx_record_unref(e->record);
 472     g_free(e);
 473 }
 474
 475 void flx_server_remove(flxServer *s, gint id) {
 476     g_assert(s);
 477
 478     if (id <= 0) {
 479         while (s->entries)
 480             free_entry(s, s->entries);
 481     } else {
 482         flxServerEntry *e;
 483
 484         while ((e = g_hash_table_lookup(s->rrset_by_id, &id)))
 485             free_entry(s, e);
 486     }
 487 }
 488
 489 void flx_server_dump(flxServer *s, FILE *f) {
 490     flxServerEntry *e;
 491     g_assert(s);
 492     g_assert(f);
 493
 494     fprintf(f, "\n;;; ZONE DUMP FOLLOWS ;;;\n");
 495
 496     for (e = s->entries; e; e = e->entry_next) {
 497         gchar *t;
 498
 499         t = flx_record_to_string(e->record);
 500         fprintf(f, "%s\n", t);
 501         g_free(t);
 502     }
 503
 504     flx_dump_caches(s->monitor, f);
 505 }
 506
 507 void flx_server_add_address(
 508     flxServer *s,
 509     gint id,
 510     gint interface,
 511     guchar protocol,
 512     gboolean unique,
 513     const gchar *name,
 514     flxAddress *a) {
 515
 516     gchar *n;
 517     g_assert(s);
 518     g_assert(a);
 519
 520     n = name ? flx_normalize_name(name) : s->hostname;
 521
 522     if (a->family == AF_INET) {
 523         gchar *r;
 524
 525         flx_server_add_full(s, id, interface, protocol, unique, n, FLX_DNS_CLASS_IN, FLX_DNS_TYPE_A, &a->data.ipv4, sizeof(a->data.ipv4), FLX_DEFAULT_TTL);
 526
 527         r = flx_reverse_lookup_name_ipv4(&a->data.ipv4);
 528         g_assert(r);
 529         flx_server_add_full(s, id, interface, protocol, unique, r, FLX_DNS_CLASS_IN, FLX_DNS_TYPE_PTR, n, strlen(n)+1, FLX_DEFAULT_TTL);
 530         g_free(r);
 531
 532     } else {
 533         gchar *r;
 534
 535         flx_server_add_full(s, id, interface, protocol, unique, n, FLX_DNS_CLASS_IN, FLX_DNS_TYPE_AAAA, &a->data.ipv6, sizeof(a->data.ipv6), FLX_DEFAULT_TTL);
 536
 537         r = flx_reverse_lookup_name_ipv6_arpa(&a->data.ipv6);
 538         g_assert(r);
 539         flx_server_add_full(s, id, interface, protocol, unique, r, FLX_DNS_CLASS_IN, FLX_DNS_TYPE_PTR, n, strlen(n)+1, FLX_DEFAULT_TTL);
 540         g_free(r);
 541
 542         r = flx_reverse_lookup_name_ipv6_int(&a->data.ipv6);
 543         g_assert(r);
 544         flx_server_add_full(s, id, interface, protocol, unique, r, FLX_DNS_CLASS_IN, FLX_DNS_TYPE_PTR, n, strlen(n)+1, FLX_DEFAULT_TTL);
 545         g_free(r);
 546     }
 547
 548     g_free(n);
 549 }
 550
 551 void flx_server_add_text(
 552     flxServer *s,
 553     gint id,
 554     gint interface,
 555     guchar protocol,
 556     gboolean unique,
 557     const gchar *name,
 558     const gchar *text) {
 559
 560     gchar buf[256];
 561     guint l;
 562
 563     g_assert(s);
 564     g_assert(text);
 565
 566     if ((l = strlen(text)) > 255)
 567         buf[0] = 255;
 568     else
 569         buf[0] = (gchar) l;
 570
 571     memcpy(buf+1, text, l);
 572
 573     flx_server_add_full(s, id, interface, protocol, unique, name, FLX_DNS_CLASS_IN, FLX_DNS_TYPE_TXT, buf, l+1, FLX_DEFAULT_TTL);
 574 }
 575
 576 static void post_query_callback(flxInterfaceMonitor *m, flxInterface *i, gpointer userdata) {
 577     flxKey *k = userdata;
 578
 579     g_assert(m);
 580     g_assert(i);
 581     g_assert(k);
 582
 583     flx_interface_post_query(i, k, FALSE);
 584 }
 585
 586 void flx_server_post_query(flxServer *s, gint interface, guchar protocol, flxKey *key) {
 587     g_assert(s);
 588     g_assert(key);
 589
 590     flx_interface_monitor_walk(s->monitor, interface, protocol, post_query_callback, key);
 591 }
 592
 593 static void post_response_callback(flxInterfaceMonitor *m, flxInterface *i, gpointer userdata) {
 594     flxRecord *r = userdata;
 595
 596     g_assert(m);
 597     g_assert(i);
 598     g_assert(r);
 599
 600     flx_interface_post_response(i, NULL, r, FALSE);
 601 }
 602
 603 void flx_server_post_response(flxServer *s, gint interface, guchar protocol, flxRecord *record) {
 604     g_assert(s);
 605     g_assert(record);
 606
 607     flx_interface_monitor_walk(s->monitor, interface, protocol, post_response_callback, record);
 608 }