2 * Copyright (C) 2014 John Crispin <blogic@openwrt.org>
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
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.
14 #include <sys/types.h>
15 #include <arpa/nameser.h>
16 #include <sys/socket.h>
25 #include <libubox/vlist.h>
26 #include <libubox/uloop.h>
27 #include <libubox/avl-cmp.h>
28 #include <libubox/blobmsg_json.h>
34 #include "interface.h"
45 struct vlist_node node
;
57 static const struct blobmsg_policy service_policy
[__SERVICE_MAX
] = {
58 [SERVICE_SERVICE
] = { .name
= "service", .type
= BLOBMSG_TYPE_STRING
},
59 [SERVICE_PORT
] = { .name
= "port", .type
= BLOBMSG_TYPE_INT32
},
60 [SERVICE_TXT
] = { .name
= "txt", .type
= BLOBMSG_TYPE_ARRAY
},
64 service_update(struct vlist_tree
*tree
, struct vlist_node
*node_new
,
65 struct vlist_node
*node_old
);
67 static struct blob_buf b
;
68 static VLIST_TREE(services
, avl_strcmp
, service_update
, false, false);
69 static char *sdudp
= "_services._dns-sd._udp.local";
70 static char *sdtcp
= "_services._dns-sd._tcp.local";
71 static int service_init_announce
;
74 service_name(const char *domain
)
76 static char buffer
[256];
78 snprintf(buffer
, sizeof(buffer
), "%s.%s", mdns_hostname
, domain
);
84 service_add_ptr(const char *host
, int ttl
)
86 int len
= dn_comp(host
, mdns_buf
, sizeof(mdns_buf
), NULL
, NULL
);
91 dns_add_answer(TYPE_PTR
, mdns_buf
, len
, ttl
);
95 service_add_srv(struct service
*s
, int ttl
)
97 struct dns_srv_data
*sd
= (struct dns_srv_data
*) mdns_buf
;
98 int len
= sizeof(*sd
);
100 len
+= dn_comp(mdns_hostname_local
, mdns_buf
+ len
, sizeof(mdns_buf
) - len
, NULL
, NULL
);
101 if (len
<= sizeof(*sd
))
104 sd
->port
= cpu_to_be16(s
->port
);
105 dns_add_answer(TYPE_SRV
, mdns_buf
, len
, ttl
);
108 #define TOUT_LOOKUP 60
111 service_timeout(struct service
*s
)
113 time_t t
= monotonic_time();
115 if (t
- s
->t
<= TOUT_LOOKUP
)
122 service_reply_a(struct interface
*iface
, int ttl
)
124 struct ifaddrs
*ifap
, *ifa
;
125 struct sockaddr_in
*sa
;
126 struct sockaddr_in6
*sa6
;
131 for (ifa
= ifap
; ifa
; ifa
= ifa
->ifa_next
) {
132 if (strcmp(ifa
->ifa_name
, iface
->name
))
134 if (ifa
->ifa_addr
->sa_family
== AF_INET
) {
135 sa
= (struct sockaddr_in
*) ifa
->ifa_addr
;
136 dns_add_answer(TYPE_A
, (uint8_t *) &sa
->sin_addr
, 4, ttl
);
138 if (ifa
->ifa_addr
->sa_family
== AF_INET6
) {
139 uint8_t ll_prefix
[] = {0xfe, 0x80 };
140 sa6
= (struct sockaddr_in6
*) ifa
->ifa_addr
;
141 if (!memcmp(&sa6
->sin6_addr
, &ll_prefix
, 2))
142 dns_add_answer(TYPE_AAAA
, (uint8_t *) &sa6
->sin6_addr
, 16, ttl
);
145 dns_send_answer(iface
, mdns_hostname_local
);
151 service_reply_single(struct interface
*iface
, struct service
*s
, const char *match
, int ttl
, int force
)
153 const char *host
= service_name(s
->service
);
154 char *service
= strstr(host
, "._");
155 time_t t
= service_timeout(s
);
158 if (!force
&& (!s
->active
|| !service
|| !t
))
163 if (match
&& strcmp(match
, s
->service
))
169 service_add_ptr(service_name(s
->service
), ttl
);
170 dns_send_answer(iface
, service
);
173 service_add_srv(s
, ttl
);
174 if (s
->txt
&& s
->txt_len
)
175 dns_add_answer(TYPE_TXT
, (uint8_t *) s
->txt
, s
->txt_len
, ttl
);
176 dns_send_answer(iface
, host
);
180 service_reply(struct interface
*iface
, const char *match
, int ttl
)
184 vlist_for_each_element(&services
, s
, node
)
185 service_reply_single(iface
, s
, match
, ttl
, 0);
191 service_reply_a(iface
, ttl
);
195 service_announce_services(struct interface
*iface
, const char *service
, int ttl
)
200 if (!strcmp(service
, sdudp
))
202 else if (strcmp(service
, sdtcp
))
205 vlist_for_each_element(&services
, s
, node
) {
206 if (!strstr(s
->service
, "._tcp") && tcp
)
208 if (!strstr(s
->service
, "._udp") && !tcp
)
213 service_add_ptr(s
->service
, ttl
);
215 dns_send_answer(iface
, sdtcp
);
217 dns_send_answer(iface
, sdudp
);
219 service_reply(iface
, s
->service
, ttl
);
224 service_announce(struct interface
*iface
, int ttl
)
226 service_announce_services(iface
, sdudp
, ttl
);
227 service_announce_services(iface
, sdtcp
, ttl
);
231 service_update(struct vlist_tree
*tree
, struct vlist_node
*node_new
,
232 struct vlist_node
*node_old
)
234 struct interface
*iface
;
238 s
= container_of(node_new
, struct service
, node
);
239 if (service_init_announce
)
240 vlist_for_each_element(&interfaces
, iface
, node
) {
242 service_reply_single(iface
, s
, NULL
, announce_ttl
, 1);
247 s
= container_of(node_old
, struct service
, node
);
248 if (!node_new
&& service_init_announce
)
249 vlist_for_each_element(&interfaces
, iface
, node
)
250 service_reply_single(iface
, s
, NULL
, 0, 1);
255 service_load_blob(struct blob_attr
*b
)
257 struct blob_attr
*txt
, *_tb
[__SERVICE_MAX
];
259 char *d_service
, *d_id
;
264 blobmsg_parse(service_policy
, ARRAY_SIZE(service_policy
),
265 _tb
, blobmsg_data(b
), blobmsg_data_len(b
));
266 if (!_tb
[SERVICE_PORT
] || !_tb
[SERVICE_SERVICE
])
269 if (_tb
[SERVICE_SERVICE
])
270 blobmsg_for_each_attr(txt
, _tb
[SERVICE_TXT
], rem2
)
271 txt_len
+= 1 + strlen(blobmsg_get_string(txt
));
273 s
= calloc_a(sizeof(*s
),
274 &d_id
, strlen(blobmsg_name(b
)) + 1,
275 &d_service
, strlen(blobmsg_get_string(_tb
[SERVICE_SERVICE
])) + 1,
280 s
->port
= blobmsg_get_u32(_tb
[SERVICE_PORT
]);
281 s
->id
= strcpy(d_id
, blobmsg_name(b
));
282 s
->service
= strcpy(d_service
, blobmsg_get_string(_tb
[SERVICE_SERVICE
]));
285 s
->txt_len
= txt_len
;
288 if (_tb
[SERVICE_SERVICE
])
289 blobmsg_for_each_attr(txt
, _tb
[SERVICE_TXT
], rem2
) {
290 int len
= strlen(blobmsg_get_string(txt
));
297 memcpy(d_txt
, blobmsg_get_string(txt
), len
);
301 vlist_add(&services
, &s
->node
, s
->id
);
305 service_load(char *path
)
307 struct blob_attr
*cur
;
311 if (glob(path
, GLOB_NOESCAPE
| GLOB_MARK
, NULL
, &gl
))
314 for (i
= 0; i
< gl
.gl_pathc
; i
++) {
315 blob_buf_init(&b
, 0);
316 if (blobmsg_add_json_from_file(&b
, gl
.gl_pathv
[i
]))
317 blob_for_each_attr(cur
, b
.head
, rem
)
318 service_load_blob(cur
);
324 service_init_cb(struct ubus_request
*req
, int type
, struct blob_attr
*msg
)
326 struct blob_attr
*cur
;
331 vlist_update(&services
);
332 service_load("/tmp/run/mdns/*");
334 blob_for_each_attr(cur
, msg
, rem
) {
335 struct blob_attr
*cur2
;
338 blobmsg_for_each_attr(cur2
, cur
, rem2
) {
339 struct blob_attr
*cur3
;
342 if (strcmp(blobmsg_name(cur2
), "instances"))
345 blobmsg_for_each_attr(cur3
, cur2
, rem3
) {
346 struct blob_attr
*cur4
;
350 blobmsg_for_each_attr(cur4
, cur3
, rem4
) {
351 const char *name
= blobmsg_name(cur4
);
353 if (!strcmp(name
, "running")) {
354 running
= blobmsg_get_bool(cur4
);
355 } else if (running
&& !strcmp(name
, "data")) {
356 struct blob_attr
*cur5
;
359 blobmsg_for_each_attr(cur5
, cur4
, rem5
) {
360 struct blob_attr
*cur6
;
363 if (strcmp(blobmsg_name(cur5
), "mdns"))
366 blobmsg_for_each_attr(cur6
, cur5
, rem6
)
367 service_load_blob(cur6
);
375 vlist_flush(&services
);
379 service_init(int announce
)
383 service_init_announce
= announce
;
384 ubus_service_list(service_init_cb
);
388 service_cleanup(void)
390 vlist_flush(&services
);