Support PTR queries for a specific service
[project/mdnsd.git] / cache.c
1 /*
2 * Copyright (C) 2014 John Crispin <blogic@openwrt.org>
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU Lesser General Public License version 2.1
6 * as published by the Free Software Foundation
7 *
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
12 */
13
14 #define _GNU_SOURCE
15 #include <sys/types.h>
16 #include <sys/stat.h>
17
18 #include <fcntl.h>
19 #include <time.h>
20 #include <stdio.h>
21 #include <string.h>
22 #include <unistd.h>
23 #include <sys/types.h>
24 #include <sys/socket.h>
25 #include <netinet/in.h>
26 #include <arpa/inet.h>
27 #include <arpa/nameser.h>
28 #include <resolv.h>
29 #include <time.h>
30
31 #include <libubox/usock.h>
32 #include <libubox/uloop.h>
33 #include <libubox/avl-cmp.h>
34 #include <libubox/blobmsg_json.h>
35 #include <libubox/kvlist.h>
36 #include <libubus.h>
37
38 #include "cache.h"
39 #include "util.h"
40 #include "dns.h"
41 #include "interface.h"
42
43 static struct uloop_timeout cache_gc;
44 struct avl_tree services;
45 AVL_TREE(records, avl_strcmp, true, NULL);
46
47 static void
48 cache_record_free(struct cache_record *r)
49 {
50 DBG(2, "%s %s\n", dns_type_string(r->type), r->record);
51 avl_delete(&records, &r->avl);
52 free(r);
53 }
54
55 static void
56 cache_service_free(struct cache_service *s)
57 {
58 DBG(2, "%s\n", s->entry);
59 avl_delete(&services, &s->avl);
60 free(s);
61 }
62
63 static int
64 cache_is_expired(time_t t, uint32_t ttl, int frac)
65 {
66 if (monotonic_time() - t >= ttl * frac / 100)
67 return 1;
68
69 return 0;
70 }
71
72 static void
73 cache_gc_timer(struct uloop_timeout *timeout)
74 {
75 struct cache_record *r, *p;
76 struct cache_service *s, *t;
77
78 avl_for_each_element_safe(&records, r, avl, p) {
79 if (!cache_is_expired(r->time, r->ttl, r->refresh))
80 continue;
81 /* Records other than A(AAA) are handled as services */
82 if (r->type != TYPE_A && r->type != TYPE_AAAA) {
83 if (cache_is_expired(r->time, r->ttl, 100))
84 cache_record_free(r);
85 continue;
86 }
87 if (r->refresh >= 100) {
88 cache_record_free(r);
89 continue;
90 }
91 r->refresh += 50;
92 dns_send_question(r->iface, (struct sockaddr *)&r->from, r->record, r->type, 0);
93 }
94
95 avl_for_each_element_safe(&services, s, avl, t) {
96 if (!s->host)
97 continue;
98 if (!cache_is_expired(s->time, s->ttl, s->refresh))
99 continue;
100 if (s->refresh >= 100) {
101 cache_service_free(s);
102 continue;
103 }
104 s->refresh += 50;
105 dns_send_question(s->iface, NULL, s->entry, TYPE_PTR, 0);
106 }
107
108 uloop_timeout_set(timeout, 10000);
109 }
110
111 int
112 cache_init(void)
113 {
114 avl_init(&services, avl_strcmp, true, NULL);
115
116 cache_gc.cb = cache_gc_timer;
117 uloop_timeout_set(&cache_gc, 10000);
118
119 return 0;
120 }
121
122 void cache_cleanup(struct interface *iface)
123 {
124 struct cache_record *r, *p;
125 struct cache_service *s, *t;
126
127 avl_for_each_element_safe(&services, s, avl, t)
128 if (!iface || iface == s->iface)
129 cache_service_free(s);
130
131 avl_for_each_element_safe(&records, r, avl, p)
132 if (!iface || iface == r->iface)
133 cache_record_free(r);
134 }
135
136 void
137 cache_update(void)
138 {
139 struct interface *iface;
140 struct cache_service *s;
141
142 vlist_for_each_element(&interfaces, iface, node)
143 avl_for_each_element(&services, s, avl)
144 dns_send_question(iface, NULL, s->entry, TYPE_PTR, 0);
145 }
146
147 static struct cache_service*
148 cache_service(struct interface *iface, char *entry, int hlen, int ttl)
149 {
150 struct cache_service *s, *t;
151 char *entry_buf;
152 char *host_buf;
153 char *type;
154
155 avl_for_each_element_safe(&services, s, avl, t)
156 if (!strcmp(s->entry, entry)) {
157 s->refresh = 50;
158 s->time = monotonic_time();
159 s->ttl = ttl;
160 return s;
161 }
162
163 s = calloc_a(sizeof(*s),
164 &entry_buf, strlen(entry) + 1,
165 &host_buf, hlen ? hlen + 1 : 0);
166
167 s->avl.key = s->entry = strcpy(entry_buf, entry);
168 s->time = monotonic_time();
169 s->ttl = ttl;
170 s->iface = iface;
171 s->refresh = 50;
172
173 if (hlen)
174 s->host = strncpy(host_buf, s->entry, hlen);
175
176 type = strstr(entry_buf, "._");
177 if (type)
178 type++;
179 if (type)
180 s->avl.key = type;
181 avl_insert(&services, &s->avl);
182
183 if (!hlen)
184 dns_send_question(iface, NULL, entry, TYPE_PTR, iface->multicast);
185
186 return s;
187 }
188
189 static struct cache_record*
190 cache_record_find(char *record, int type, int port, int rdlength, uint8_t *rdata)
191 {
192 struct cache_record *l = avl_find_element(&records, record, l, avl);
193
194 if (!l)
195 return NULL;
196
197 while (l && l->record && !strcmp(l->record, record)) {
198 struct cache_record *r = l;
199
200 l = avl_next_element(l, avl);
201 if (r->type != type)
202 continue;
203
204 if (r->type == TYPE_TXT || (r->type == TYPE_SRV))
205 return r;
206
207 if (r->port != port)
208 continue;
209
210 if (r->rdlength != rdlength)
211 continue;
212
213 if (!!r->rdata != !!rdata)
214 continue;
215
216 if (!r->rdata || !rdata || memcmp(r->rdata, rdata, rdlength))
217 continue;
218
219 return r;
220 }
221
222 return NULL;
223 }
224
225 int
226 cache_host_is_known(char *record)
227 {
228 struct cache_record *l = avl_find_element(&records, record, l, avl);
229
230 if (!l)
231 return 0;
232
233 while (l && !avl_is_last(&records, &l->avl) && !strcmp(l->record, record)) {
234 struct cache_record *r = l;
235
236 l = avl_next_element(l, avl);
237 if ((r->type != TYPE_A) && (r->type != TYPE_AAAA))
238 continue;
239 return 1;
240 }
241
242 return 0;
243 }
244
245 void cache_answer(struct interface *iface, struct sockaddr *from, uint8_t *base,
246 int blen, char *name, struct dns_answer *a, uint8_t *rdata,
247 int flush)
248 {
249 struct dns_srv_data *dsd = (struct dns_srv_data *) rdata;
250 struct cache_record *r;
251 int port = 0, dlen = 0, tlen = 0, nlen, rdlength;
252 char *p = NULL;
253 char *name_buf;
254 void *rdata_ptr, *txt_ptr;
255 int host_len = 0;
256 static char *rdata_buffer = (char *) mdns_buf;
257 time_t now = monotonic_time();
258
259 nlen = strlen(name);
260
261 switch (a->type) {
262 case TYPE_PTR:
263 if (a->rdlength < 2)
264 return;
265
266 if (dn_expand(base, base + blen, rdata, rdata_buffer, MAX_DATA_LEN) < 0) {
267 perror("process_answer/dn_expand");
268 return;
269 }
270
271 DBG(1, "A -> %s %s %s ttl:%d\n", dns_type_string(a->type), name, rdata_buffer, a->ttl);
272
273 rdlength = strlen(rdata_buffer);
274
275 if (strcmp(C_DNS_SD, name) != 0 &&
276 nlen + 1 < rdlength && !strcmp(rdata_buffer + rdlength - nlen, name))
277 host_len = rdlength - nlen - 1;
278
279 if (name[0] == '_')
280 cache_service(iface, rdata_buffer, host_len, a->ttl);
281
282 dlen = strlen(rdata_buffer) + 1;
283 rdata = (uint8_t*)rdata_buffer;
284 break;
285
286 case TYPE_SRV:
287 if (a->rdlength < 8)
288 return;
289
290 port = be16_to_cpu(dsd->port);
291 memcpy(rdata_buffer, dsd, sizeof(*dsd));
292 if (dn_expand(base, base + blen, (const uint8_t*)&dsd[1],
293 &rdata_buffer[sizeof(*dsd)], MAX_DATA_LEN - sizeof(*dsd)) < 0) {
294 perror("process_answer/dn_expand");
295 return;
296 }
297 dlen = sizeof(*dsd) + strlen(&rdata_buffer[sizeof(*dsd)]) + 1;
298 rdata = (uint8_t*)rdata_buffer;
299 break;
300
301 case TYPE_TXT:
302 rdlength = a->rdlength;
303 if (rdlength <= 2)
304 return;
305
306 memcpy(rdata_buffer, &rdata[1], rdlength);
307 rdata_buffer[rdlength] = rdata_buffer[rdlength + 1] = '\0';
308 tlen = rdlength + 1;
309 p = &rdata_buffer[*rdata];
310
311 do {
312 uint8_t v = *p;
313
314 *p = '\0';
315 if (v && p + v < &rdata_buffer[rdlength])
316 p += v + 1;
317 } while (*p);
318 break;
319
320 case TYPE_A:
321 if (a->rdlength != 4)
322 return;
323 dlen = 4;
324 break;
325
326 case TYPE_AAAA:
327 if (a->rdlength != 16)
328 return;
329 dlen = 16;
330 break;
331
332 default:
333 return;
334 }
335
336 r = cache_record_find(name, a->type, port, dlen, rdata);
337 if (r) {
338 if (!a->ttl) {
339 DBG(1, "D -> %s %s ttl:%d\n", dns_type_string(r->type), r->record, r->ttl);
340 r->time = now + 1 - r->ttl;
341 r->refresh = 100;
342 } else {
343 r->ttl = a->ttl;
344 r->time = now;
345 r->refresh = 50;
346 DBG(1, "A -> %s %s ttl:%d\n", dns_type_string(r->type), r->record, r->ttl);
347 }
348 return;
349 }
350
351 if (!a->ttl)
352 return;
353
354 r = calloc_a(sizeof(*r),
355 &name_buf, strlen(name) + 1,
356 &txt_ptr, tlen,
357 &rdata_ptr, dlen);
358
359 r->avl.key = r->record = strcpy(name_buf, name);
360 r->type = a->type;
361 r->ttl = a->ttl;
362 r->port = port;
363 r->rdlength = dlen;
364 r->time = now;
365 r->iface = iface;
366 if (iface->v6)
367 memcpy(&r->from, from, sizeof(struct sockaddr_in6));
368 else
369 memcpy(&r->from, from, sizeof(struct sockaddr_in));
370 r->refresh = 50;
371
372 if (tlen)
373 r->txt = memcpy(txt_ptr, rdata_buffer, tlen);
374
375 if (dlen)
376 r->rdata = memcpy(rdata_ptr, rdata, dlen);
377
378 if (avl_insert(&records, &r->avl))
379 free(r);
380 else
381 DBG(1, "A -> %s %s ttl:%d\n", dns_type_string(r->type), r->record, r->ttl);
382 }
383
384 void
385 cache_dump_records(struct blob_buf *buf, const char *name)
386 {
387 struct cache_record *r, *last, *next;
388 const char *txt;
389 char buffer[INET6_ADDRSTRLEN];
390
391 last = avl_last_element(&records, last, avl);
392 for (r = avl_find_element(&records, name, r, avl); r; r = next) {
393 switch (r->type) {
394 case TYPE_TXT:
395 if (r->txt && strlen(r->txt)) {
396 txt = r->txt;
397 do {
398 blobmsg_add_string(buf, "txt", txt);
399 txt = &txt[strlen(txt) + 1];
400 } while (*txt);
401 }
402 break;
403
404 case TYPE_SRV:
405 if (r->port)
406 blobmsg_add_u32(buf, "port", r->port);
407 break;
408
409 case TYPE_A:
410 if ((r->rdlength == 4) && inet_ntop(AF_INET, r->rdata, buffer, INET6_ADDRSTRLEN))
411 blobmsg_add_string(buf, "ipv4", buffer);
412 break;
413
414 case TYPE_AAAA:
415 if ((r->rdlength == 16) && inet_ntop(AF_INET6, r->rdata, buffer, INET6_ADDRSTRLEN))
416 blobmsg_add_string(buf, "ipv6", buffer);
417 break;
418 }
419
420 if (r == last)
421 break;
422
423 next = avl_next_element(r, avl);
424 if (strcmp(r->record, next->record) != 0)
425 break;
426 }
427 }
428
429 void
430 cache_dump_recursive(struct blob_buf *b, const char *name, uint16_t type, struct interface *iface)
431 {
432 time_t now = monotonic_time();
433 for (struct cache_record *r = avl_find_ge_element(&records, name, r, avl);
434 r && !strcmp(r->record, name);
435 r = !avl_is_last(&records, &r->avl) ? avl_next_element(r, avl) : NULL) {
436 int32_t ttl = r->ttl - (now - r->time);
437 if (ttl <= 0 || (iface && iface->ifindex != r->iface->ifindex) ||
438 (type != TYPE_ANY && type != r->type))
439 continue;
440
441 const char *txt;
442 char buf[INET6_ADDRSTRLEN];
443 void *k = blobmsg_open_table(b, NULL), *l;
444 const struct dns_srv_data *dsd = (const struct dns_srv_data*)r->rdata;
445
446 blobmsg_add_string(b, "name", r->record);
447 blobmsg_add_string(b, "type", dns_type_string(r->type));
448 blobmsg_add_u32(b, "ttl", ttl);
449
450 switch (r->type) {
451 case TYPE_TXT:
452 if ((txt = r->txt) && strlen(txt)) {
453 l = blobmsg_open_array(b, "data");
454 do {
455 blobmsg_add_string(b, NULL, txt);
456 txt = &txt[strlen(txt) + 1];
457 } while (*txt);
458 blobmsg_close_array(b, l);
459 }
460 break;
461
462 case TYPE_SRV:
463 if (r->rdlength > sizeof(*dsd)) {
464 blobmsg_add_u32(b, "priority", be16_to_cpu(dsd->priority));
465 blobmsg_add_u32(b, "weight", be16_to_cpu(dsd->weight));
466 blobmsg_add_u32(b, "port", be16_to_cpu(dsd->port));
467 blobmsg_add_string(b, "target", (const char*)&dsd[1]);
468 }
469 break;
470
471 case TYPE_PTR:
472 if (r->rdlength > 0)
473 blobmsg_add_string(b, "target", (const char*)r->rdata);
474 break;
475
476 case TYPE_A:
477 if ((r->rdlength == 4) && inet_ntop(AF_INET, r->rdata, buf, sizeof(buf)))
478 blobmsg_add_string(b, "target", buf);
479 break;
480
481 case TYPE_AAAA:
482 if ((r->rdlength == 16) && inet_ntop(AF_INET6, r->rdata, buf, sizeof(buf)))
483 blobmsg_add_string(b, "target", buf);
484 break;
485 }
486
487 blobmsg_close_table(b, k);
488
489
490 if (r->type == TYPE_PTR) {
491 cache_dump_recursive(b, (const char*)r->rdata, TYPE_SRV, iface);
492 cache_dump_recursive(b, (const char*)r->rdata, TYPE_TXT, iface);
493 }
494
495 if (r->type == TYPE_SRV) {
496 cache_dump_recursive(b, (const char*)&dsd[1], TYPE_A, iface);
497 cache_dump_recursive(b, (const char*)&dsd[1], TYPE_AAAA, iface);
498 }
499 }
500 }