5 * Copyright (C) 2007-2010 Intel Corporation. All rights reserved.
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
30 #include <arpa/inet.h>
31 #include <netinet/in.h>
32 #include <sys/types.h>
33 #include <sys/socket.h>
40 #if __BYTE_ORDER == __LITTLE_ENDIAN
55 } __attribute__ ((packed));
56 #elif __BYTE_ORDER == __BIG_ENDIAN
71 } __attribute__ ((packed));
73 #error "Unknown byte order"
76 struct partial_reply {
92 struct partial_reply *incoming_reply;
97 struct sockaddr_in6 __sin6; /* Only for the length */
117 static GSList *server_list = NULL;
118 static GSList *request_list = NULL;
119 static GSList *request_pending_list = NULL;
120 static guint16 request_id = 0x0000;
122 static GIOChannel *udp_listener_channel = NULL;
123 static guint udp_listener_watch = 0;
124 static GIOChannel *tcp_listener_channel = NULL;
125 static guint tcp_listener_watch = 0;
127 static int protocol_offset(int protocol)
142 static struct request_data *find_request(guint16 id)
146 for (list = request_list; list; list = list->next) {
147 struct request_data *req = list->data;
149 if (req->dstid == id || req->altid == id)
156 static struct server_data *find_server(const char *interface,
162 DBG("interface %s server %s", interface, server);
164 for (list = server_list; list; list = list->next) {
165 struct server_data *data = list->data;
167 if (interface == NULL && data->interface == NULL &&
168 g_str_equal(data->server, server) == TRUE &&
169 data->protocol == protocol)
172 if (interface == NULL ||
173 data->interface == NULL || data->server == NULL)
176 if (g_str_equal(data->interface, interface) == TRUE &&
177 g_str_equal(data->server, server) == TRUE &&
178 data->protocol == protocol)
186 static void send_response(int sk, unsigned char *buf, int len,
187 const struct sockaddr *to, socklen_t tolen,
190 struct domain_hdr *hdr;
191 int err, offset = protocol_offset(protocol);
201 hdr = (void *) (buf + offset);
203 DBG("id 0x%04x qr %d opcode %d", hdr->id, hdr->qr, hdr->opcode);
212 err = sendto(sk, buf, len, 0, to, tolen);
215 static gboolean request_timeout(gpointer user_data)
217 struct request_data *req = user_data;
219 DBG("id 0x%04x", req->srcid);
224 request_list = g_slist_remove(request_list, req);
227 if (req->resplen > 0 && req->resp != NULL) {
230 sk = g_io_channel_unix_get_fd(udp_listener_channel);
232 err = sendto(sk, req->resp, req->resplen, 0,
233 &req->sa, req->sa_len);
234 } else if (req->request && req->numserv == 0) {
235 struct domain_hdr *hdr;
237 if (req->protocol == IPPROTO_TCP) {
238 hdr = (void *) (req->request + 2);
239 hdr->id = req->srcid;
240 send_response(req->client_sk, req->request,
241 req->request_len, NULL, 0, IPPROTO_TCP);
243 } else if (req->protocol == IPPROTO_UDP) {
246 hdr = (void *) (req->request);
247 hdr->id = req->srcid;
248 sk = g_io_channel_unix_get_fd(udp_listener_channel);
249 send_response(sk, req->request, req->request_len,
250 &req->sa, req->sa_len, IPPROTO_UDP);
260 static int append_query(unsigned char *buf, unsigned int size,
261 const char *query, const char *domain)
263 unsigned char *ptr = buf;
266 DBG("query %s domain %s", query, domain);
268 offset = (char *) query;
269 while (offset != NULL) {
272 tmp = strchr(offset, '.');
274 if (strlen(offset) == 0)
276 *ptr = strlen(offset);
277 memcpy(ptr + 1, offset, strlen(offset));
278 ptr += strlen(offset) + 1;
283 memcpy(ptr + 1, offset, tmp - offset);
284 ptr += tmp - offset + 1;
289 offset = (char *) domain;
290 while (offset != NULL) {
293 tmp = strchr(offset, '.');
295 if (strlen(offset) == 0)
297 *ptr = strlen(offset);
298 memcpy(ptr + 1, offset, strlen(offset));
299 ptr += strlen(offset) + 1;
304 memcpy(ptr + 1, offset, tmp - offset);
305 ptr += tmp - offset + 1;
315 static int ns_resolv(struct server_data *server, struct request_data *req,
316 gpointer request, gpointer name)
320 char *dot, *lookup = (char *) name;
322 sk = g_io_channel_unix_get_fd(server->channel);
324 err = send(sk, request, req->request_len, 0);
328 /* If we have more than one dot, we don't add domains */
329 dot = strchr(lookup, '.');
330 if (dot != NULL && dot != lookup + strlen(lookup) - 1)
333 for (list = server->domains; list; list = list->next) {
335 unsigned char alt[1024];
336 struct domain_hdr *hdr = (void *) &alt;
337 int altlen, domlen, offset;
344 offset = protocol_offset(server->protocol);
348 domlen = strlen(domain) + 1;
352 alt[offset] = req->altid & 0xff;
353 alt[offset + 1] = req->altid >> 8;
355 memcpy(alt + offset + 2, request + offset + 2, 10);
356 hdr->qdcount = htons(1);
358 altlen = append_query(alt + offset + 12, sizeof(alt) - 12,
365 memcpy(alt + offset + altlen,
366 request + offset + altlen - domlen,
367 req->request_len - altlen + domlen);
369 if (server->protocol == IPPROTO_TCP) {
370 int req_len = req->request_len + domlen - 1;
372 alt[0] = (req_len >> 8) & 0xff;
373 alt[1] = req_len & 0xff;
376 err = send(sk, alt, req->request_len + domlen + 1, 0);
384 static int forward_dns_reply(unsigned char *reply, int reply_len, int protocol)
386 struct domain_hdr *hdr;
387 struct request_data *req;
388 int dns_id, sk, err, offset = protocol_offset(protocol);
393 hdr = (void *)(reply + offset);
394 dns_id = reply[offset] | reply[offset + 1] << 8;
396 DBG("Received %d bytes (id 0x%04x)", reply_len, dns_id);
398 req = find_request(dns_id);
402 DBG("id 0x%04x rcode %d", hdr->id, hdr->rcode);
404 reply[offset] = req->srcid & 0xff;
405 reply[offset + 1] = req->srcid >> 8;
409 if (hdr->rcode == 0 || req->resp == NULL) {
413 req->resp = g_try_malloc(reply_len);
414 if (req->resp == NULL)
417 memcpy(req->resp, reply, reply_len);
418 req->resplen = reply_len;
421 if (hdr->rcode > 0 && req->numresp < req->numserv)
424 if (req->timeout > 0)
425 g_source_remove(req->timeout);
427 request_list = g_slist_remove(request_list, req);
429 if (protocol == IPPROTO_UDP) {
430 sk = g_io_channel_unix_get_fd(udp_listener_channel);
431 err = sendto(sk, req->resp, req->resplen, 0,
432 &req->sa, req->sa_len);
435 err = send(sk, req->resp, req->resplen, 0);
445 static void destroy_server(struct server_data *server)
449 DBG("interface %s server %s", server->interface, server->server);
451 server_list = g_slist_remove(server_list, server);
453 if (server->watch > 0)
454 g_source_remove(server->watch);
456 if (server->timeout > 0)
457 g_source_remove(server->timeout);
459 g_io_channel_unref(server->channel);
461 if (server->protocol == IPPROTO_UDP)
462 connman_info("Removing DNS server %s", server->server);
464 g_free(server->incoming_reply);
465 g_free(server->server);
466 for (list = server->domains; list; list = list->next) {
467 char *domain = list->data;
469 server->domains = g_list_remove(server->domains, domain);
472 g_free(server->interface);
476 static gboolean udp_server_event(GIOChannel *channel, GIOCondition condition,
479 unsigned char buf[4096];
482 if (condition & (G_IO_NVAL | G_IO_ERR | G_IO_HUP)) {
483 struct server_data *data = user_data;
485 connman_error("Error with UDP server %s", data->server);
490 sk = g_io_channel_unix_get_fd(channel);
492 len = recv(sk, buf, sizeof(buf), 0);
496 err = forward_dns_reply(buf, len, IPPROTO_UDP);
501 static gboolean tcp_server_event(GIOChannel *channel, GIOCondition condition,
505 struct server_data *server = user_data;
507 sk = g_io_channel_unix_get_fd(channel);
511 if (condition & (G_IO_NVAL | G_IO_ERR | G_IO_HUP)) {
514 DBG("TCP server channel closed");
517 * Discard any partial response which is buffered; better
518 * to get a proper response from a working server.
520 g_free(server->incoming_reply);
521 server->incoming_reply = NULL;
523 for (list = request_list; list; list = list->next) {
524 struct request_data *req = list->data;
525 struct domain_hdr *hdr;
527 if (req->protocol == IPPROTO_UDP)
530 if (req->request == NULL)
534 * If we're not waiting for any further response
535 * from another name server, then we send an error
536 * response to the client.
538 if (req->numserv && --(req->numserv))
541 hdr = (void *) (req->request + 2);
542 hdr->id = req->srcid;
543 send_response(req->client_sk, req->request,
544 req->request_len, NULL, 0, IPPROTO_TCP);
546 request_list = g_slist_remove(request_list, req);
549 destroy_server(server);
554 if ((condition & G_IO_OUT) && !server->connected) {
557 struct server_data *udp_server;
559 udp_server = find_server(server->interface, server->server,
561 if (udp_server != NULL) {
562 for (domains = udp_server->domains; domains;
563 domains = domains->next) {
564 char *dom = domains->data;
566 DBG("Adding domain %s to %s",
567 dom, server->server);
569 server->domains = g_list_append(server->domains,
574 server->connected = TRUE;
575 server_list = g_slist_append(server_list, server);
577 if (server->timeout > 0) {
578 g_source_remove(server->timeout);
582 for (list = request_list; list; list = list->next) {
583 struct request_data *req = list->data;
585 if (req->protocol == IPPROTO_UDP)
588 DBG("Sending req %s over TCP", (char *)req->name);
590 if (req->timeout > 0)
591 g_source_remove(req->timeout);
593 req->timeout = g_timeout_add_seconds(30,
594 request_timeout, req);
595 ns_resolv(server, req, req->request, req->name);
598 } else if (condition & G_IO_IN) {
599 struct partial_reply *reply = server->incoming_reply;
603 unsigned char reply_len_buf[2];
606 bytes_recv = recv(sk, reply_len_buf, 2, MSG_PEEK);
609 } else if (bytes_recv < 0) {
610 if (errno == EAGAIN || errno == EWOULDBLOCK)
613 connman_error("DNS proxy error %s",
616 } else if (bytes_recv < 2)
619 reply_len = reply_len_buf[1] | reply_len_buf[0] << 8;
622 DBG("TCP reply %d bytes", reply_len);
624 reply = g_try_malloc(sizeof(*reply) + reply_len + 2);
628 reply->len = reply_len;
631 server->incoming_reply = reply;
634 while (reply->received < reply->len) {
635 bytes_recv = recv(sk, reply->buf + reply->received,
636 reply->len - reply->received, 0);
638 connman_error("DNS proxy TCP disconnect");
640 } else if (bytes_recv < 0) {
641 if (errno == EAGAIN || errno == EWOULDBLOCK)
644 connman_error("DNS proxy error %s",
648 reply->received += bytes_recv;
651 forward_dns_reply(reply->buf, reply->received, IPPROTO_TCP);
654 server->incoming_reply = NULL;
656 destroy_server(server);
664 static gboolean tcp_idle_timeout(gpointer user_data)
666 struct server_data *server = user_data;
673 destroy_server(server);
678 static struct server_data *create_server(const char *interface,
679 const char *domain, const char *server,
682 struct addrinfo hints, *rp;
683 struct server_data *data;
686 DBG("interface %s server %s", interface, server);
688 memset(&hints, 0, sizeof(hints));
692 hints.ai_socktype = SOCK_DGRAM;
696 hints.ai_socktype = SOCK_STREAM;
702 hints.ai_family = AF_UNSPEC;
703 hints.ai_flags = AI_PASSIVE | AI_NUMERICSERV | AI_NUMERICHOST;
705 ret = getaddrinfo(server, "53", &hints, &rp);
707 connman_error("Failed to parse server %s address: %s\n",
708 server, gai_strerror(ret));
711 /* Do not blindly copy this code elsewhere; it doesn't loop over the
712 results using ->ai_next as it should. That's OK in *this* case
713 because it was a numeric lookup; we *know* there's only one. */
715 sk = socket(rp->ai_family, rp->ai_socktype, rp->ai_protocol);
717 connman_error("Failed to create server %s socket", server);
722 if (interface != NULL) {
723 if (setsockopt(sk, SOL_SOCKET, SO_BINDTODEVICE,
724 interface, strlen(interface) + 1) < 0) {
725 connman_error("Failed to bind server %s "
734 data = g_try_new0(struct server_data, 1);
736 connman_error("Failed to allocate server %s data", server);
742 data->channel = g_io_channel_unix_new(sk);
743 if (data->channel == NULL) {
744 connman_error("Failed to create server %s channel", server);
751 g_io_channel_set_close_on_unref(data->channel, TRUE);
753 if (protocol == IPPROTO_TCP) {
754 g_io_channel_set_flags(data->channel, G_IO_FLAG_NONBLOCK, NULL);
755 data->watch = g_io_add_watch(data->channel,
756 G_IO_OUT | G_IO_IN | G_IO_HUP | G_IO_NVAL | G_IO_ERR,
757 tcp_server_event, data);
758 data->timeout = g_timeout_add_seconds(30, tcp_idle_timeout,
761 data->watch = g_io_add_watch(data->channel,
762 G_IO_IN | G_IO_NVAL | G_IO_ERR | G_IO_HUP,
763 udp_server_event, data);
765 data->interface = g_strdup(interface);
767 data->domains = g_list_append(data->domains, g_strdup(domain));
768 data->server = g_strdup(server);
769 data->protocol = protocol;
771 ret = connect(sk, rp->ai_addr, rp->ai_addrlen);
774 if ((protocol == IPPROTO_TCP && errno != EINPROGRESS) ||
775 protocol == IPPROTO_UDP) {
778 connman_error("Failed to connect to server %s", server);
780 g_source_remove(data->watch);
781 if (data->timeout > 0)
782 g_source_remove(data->timeout);
784 g_io_channel_unref(data->channel);
787 g_free(data->server);
788 g_free(data->interface);
789 for (list = data->domains; list; list = list->next) {
790 char *domain = list->data;
792 data->domains = g_list_remove(data->domains,
801 if (protocol == IPPROTO_UDP) {
802 /* Enable new servers by default */
803 data->enabled = TRUE;
804 connman_info("Adding DNS server %s", data->server);
806 server_list = g_slist_append(server_list, data);
814 static gboolean resolv(struct request_data *req,
815 gpointer request, gpointer name)
819 for (list = server_list; list; list = list->next) {
820 struct server_data *data = list->data;
822 DBG("server %s enabled %d", data->server, data->enabled);
824 if (data->enabled == FALSE)
827 if (data->watch == 0 && data->protocol == IPPROTO_UDP)
828 data->watch = g_io_add_watch(data->channel,
829 G_IO_IN | G_IO_NVAL | G_IO_ERR | G_IO_HUP,
830 udp_server_event, data);
832 if (ns_resolv(data, req, request, name) < 0)
839 static void append_domain(const char *interface, const char *domain)
843 DBG("interface %s domain %s", interface, domain);
848 for (list = server_list; list; list = list->next) {
849 struct server_data *data = list->data;
852 gboolean dom_found = FALSE;
854 if (data->interface == NULL)
857 if (g_str_equal(data->interface, interface) == FALSE)
860 for (dom_list = data->domains; dom_list;
861 dom_list = dom_list->next) {
862 dom = dom_list->data;
864 if (g_str_equal(dom, domain)) {
870 if (dom_found == FALSE) {
872 g_list_append(data->domains, g_strdup(domain));
877 int __connman_dnsproxy_append(const char *interface, const char *domain,
880 struct server_data *data;
882 DBG("interface %s server %s", interface, server);
884 if (server == NULL && domain == NULL)
887 if (server == NULL) {
888 append_domain(interface, domain);
893 if (g_str_equal(server, "127.0.0.1") == TRUE)
896 data = find_server(interface, server, IPPROTO_UDP);
898 append_domain(interface, domain);
902 data = create_server(interface, domain, server, IPPROTO_UDP);
909 static void remove_server(const char *interface, const char *domain,
910 const char *server, int protocol)
912 struct server_data *data;
914 data = find_server(interface, server, protocol);
918 destroy_server(data);
921 int __connman_dnsproxy_remove(const char *interface, const char *domain,
924 DBG("interface %s server %s", interface, server);
929 if (g_str_equal(server, "127.0.0.1") == TRUE)
932 remove_server(interface, domain, server, IPPROTO_UDP);
933 remove_server(interface, domain, server, IPPROTO_TCP);
938 void __connman_dnsproxy_flush(void)
942 list = request_pending_list;
944 struct request_data *req = list->data;
948 request_pending_list =
949 g_slist_remove(request_pending_list, req);
950 resolv(req, req->request, req->name);
951 g_free(req->request);
956 static void dnsproxy_offline_mode(connman_bool_t enabled)
960 DBG("enabled %d", enabled);
962 for (list = server_list; list; list = list->next) {
963 struct server_data *data = list->data;
965 if (enabled == FALSE) {
966 connman_info("Enabling DNS server %s", data->server);
967 data->enabled = TRUE;
969 connman_info("Disabling DNS server %s", data->server);
970 data->enabled = FALSE;
975 static void dnsproxy_default_changed(struct connman_service *service)
980 DBG("service %p", service);
982 if (service == NULL) {
983 /* When no services are active, then disable DNS proxying */
984 dnsproxy_offline_mode(TRUE);
988 interface = connman_service_get_interface(service);
989 if (interface == NULL)
992 for (list = server_list; list; list = list->next) {
993 struct server_data *data = list->data;
995 if (g_strcmp0(data->interface, interface) == 0) {
996 connman_info("Enabling DNS server %s", data->server);
997 data->enabled = TRUE;
999 connman_info("Disabling DNS server %s", data->server);
1000 data->enabled = FALSE;
1007 static struct connman_notifier dnsproxy_notifier = {
1009 .default_changed = dnsproxy_default_changed,
1010 .offline_mode = dnsproxy_offline_mode,
1013 static unsigned char opt_edns0_type[2] = { 0x00, 0x29 };
1015 static int parse_request(unsigned char *buf, int len,
1016 char *name, unsigned int size)
1018 struct domain_hdr *hdr = (void *) buf;
1019 uint16_t qdcount = ntohs(hdr->qdcount);
1020 uint16_t arcount = ntohs(hdr->arcount);
1022 char *last_label = NULL;
1023 unsigned int remain, used = 0;
1028 DBG("id 0x%04x qr %d opcode %d qdcount %d arcount %d",
1029 hdr->id, hdr->qr, hdr->opcode,
1032 if (hdr->qr != 0 || qdcount != 1)
1035 memset(name, 0, size);
1037 ptr = buf + sizeof(struct domain_hdr);
1038 remain = len - sizeof(struct domain_hdr);
1040 while (remain > 0) {
1044 last_label = (char *) (ptr + 1);
1048 if (used + len + 1 > size)
1051 strncat(name, (char *) (ptr + 1), len);
1060 if (last_label && arcount && remain >= 9 && last_label[4] == 0 &&
1061 !memcmp(last_label + 5, opt_edns0_type, 2)) {
1062 uint16_t edns0_bufsize;
1064 edns0_bufsize = last_label[7] << 8 | last_label[8];
1066 DBG("EDNS0 buffer size %u", edns0_bufsize);
1068 /* This is an evil hack until full TCP support has been
1071 * Somtimes the EDNS0 request gets send with a too-small
1072 * buffer size. Since glibc doesn't seem to crash when it
1073 * gets a response biffer then it requested, just bump
1074 * the buffer size up to 4KiB.
1076 if (edns0_bufsize < 0x1000) {
1077 last_label[7] = 0x10;
1078 last_label[8] = 0x00;
1082 DBG("query %s", name);
1087 static gboolean tcp_listener_event(GIOChannel *channel, GIOCondition condition,
1090 unsigned char buf[768];
1092 struct request_data *req;
1093 struct server_data *server;
1094 int sk, client_sk, len, err;
1095 struct sockaddr_in6 client_addr;
1096 socklen_t client_addr_len = sizeof(client_addr);
1099 DBG("condition 0x%x", condition);
1101 if (condition & (G_IO_NVAL | G_IO_ERR | G_IO_HUP)) {
1102 if (tcp_listener_watch > 0)
1103 g_source_remove(tcp_listener_watch);
1104 tcp_listener_watch = 0;
1106 connman_error("Error with TCP listener channel");
1111 sk = g_io_channel_unix_get_fd(channel);
1113 client_sk = accept(sk, (void *)&client_addr, &client_addr_len);
1114 if (client_sk < 0) {
1115 connman_error("Accept failure on TCP listener");
1116 tcp_listener_watch = 0;
1120 len = recv(client_sk, buf, sizeof(buf), 0);
1124 DBG("Received %d bytes (id 0x%04x)", len, buf[2] | buf[3] << 8);
1126 err = parse_request(buf + 2, len - 2, query, sizeof(query));
1127 if (err < 0 || (g_slist_length(server_list) == 0)) {
1128 send_response(client_sk, buf, len, NULL, 0, IPPROTO_TCP);
1132 req = g_try_new0(struct request_data, 1);
1136 memcpy(&req->sa, &client_addr, client_addr_len);
1137 req->sa_len = client_addr_len;
1138 req->client_sk = client_sk;
1139 req->protocol = IPPROTO_TCP;
1142 if (request_id == 0x0000 || request_id == 0xffff)
1145 req->srcid = buf[2] | (buf[3] << 8);
1146 req->dstid = request_id;
1147 req->altid = request_id + 1;
1148 req->request_len = len;
1150 buf[2] = req->dstid & 0xff;
1151 buf[3] = req->dstid >> 8;
1154 request_list = g_slist_append(request_list, req);
1156 for (list = server_list; list; list = list->next) {
1157 struct server_data *data = list->data;
1160 if (data->protocol != IPPROTO_UDP || data->enabled == FALSE)
1163 server = create_server(data->interface, NULL,
1164 data->server, IPPROTO_TCP);
1167 * If server is NULL, we're not connected yet.
1168 * Copy the relevant buffers and continue with
1169 * the next nameserver.
1170 * The request will actually be sent once we're
1171 * properly connected over TCP to this nameserver.
1173 if (server == NULL) {
1174 req->request = g_try_malloc0(req->request_len);
1175 if (req->request == NULL)
1178 memcpy(req->request, buf, req->request_len);
1180 req->name = g_try_malloc0(sizeof(query));
1181 if (req->name == NULL) {
1182 g_free(req->request);
1185 memcpy(req->name, query, sizeof(query));
1190 if (req->timeout > 0)
1191 g_source_remove(req->timeout);
1193 for (domains = data->domains; domains;
1194 domains = domains->next) {
1195 char *dom = domains->data;
1197 DBG("Adding domain %s to %s", dom, server->server);
1199 server->domains = g_list_append(server->domains,
1203 req->timeout = g_timeout_add_seconds(30, request_timeout, req);
1204 ns_resolv(server, req, buf, query);
1210 static gboolean udp_listener_event(GIOChannel *channel, GIOCondition condition,
1213 unsigned char buf[768];
1215 struct request_data *req;
1216 struct sockaddr_in6 client_addr;
1217 socklen_t client_addr_len = sizeof(client_addr);
1220 if (condition & (G_IO_NVAL | G_IO_ERR | G_IO_HUP)) {
1221 connman_error("Error with UDP listener channel");
1222 udp_listener_watch = 0;
1226 sk = g_io_channel_unix_get_fd(channel);
1228 memset(&client_addr, 0, client_addr_len);
1229 len = recvfrom(sk, buf, sizeof(buf), 0, (void *)&client_addr,
1234 DBG("Received %d bytes (id 0x%04x)", len, buf[0] | buf[1] << 8);
1236 err = parse_request(buf, len, query, sizeof(query));
1237 if (err < 0 || (g_slist_length(server_list) == 0)) {
1238 send_response(sk, buf, len, (void *)&client_addr,
1239 client_addr_len, IPPROTO_UDP);
1243 req = g_try_new0(struct request_data, 1);
1247 memcpy(&req->sa, &client_addr, client_addr_len);
1248 req->sa_len = client_addr_len;
1250 req->protocol = IPPROTO_UDP;
1253 if (request_id == 0x0000 || request_id == 0xffff)
1256 req->srcid = buf[0] | (buf[1] << 8);
1257 req->dstid = request_id;
1258 req->altid = request_id + 1;
1259 req->request_len = len;
1261 buf[0] = req->dstid & 0xff;
1262 buf[1] = req->dstid >> 8;
1265 req->timeout = g_timeout_add_seconds(5, request_timeout, req);
1266 request_list = g_slist_append(request_list, req);
1268 return resolv(req, buf, query);
1271 static int create_dns_listener(int protocol)
1273 GIOChannel *channel;
1274 const char *ifname = "lo", *proto;
1277 struct sockaddr_in6 sin6;
1278 struct sockaddr_in sin;
1281 int sk, type, v6only = 0;
1282 int family = AF_INET6;
1301 sk = socket(family, type, protocol);
1302 if (sk < 0 && family == AF_INET6 && errno == EAFNOSUPPORT) {
1303 connman_error("No IPv6 support; DNS proxy listening only on Legacy IP");
1305 sk = socket(family, type, protocol);
1308 connman_error("Failed to create %s listener socket", proto);
1312 if (setsockopt(sk, SOL_SOCKET, SO_BINDTODEVICE,
1313 ifname, strlen(ifname) + 1) < 0) {
1314 connman_error("Failed to bind %s listener interface", proto);
1318 /* Ensure it accepts Legacy IP connections too */
1319 if (family == AF_INET6 &&
1320 setsockopt(sk, SOL_IPV6, IPV6_V6ONLY,
1321 &v6only, sizeof(v6only)) < 0) {
1322 connman_error("Failed to clear V6ONLY on %s listener socket",
1328 if (family == AF_INET) {
1329 memset(&s.sin, 0, sizeof(s.sin));
1330 s.sin.sin_family = AF_INET;
1331 s.sin.sin_port = htons(53);
1332 s.sin.sin_addr.s_addr = htonl(INADDR_ANY);
1333 slen = sizeof(s.sin);
1335 memset(&s.sin6, 0, sizeof(s.sin6));
1336 s.sin6.sin6_family = AF_INET6;
1337 s.sin6.sin6_port = htons(53);
1338 s.sin6.sin6_addr = in6addr_any;
1339 slen = sizeof(s.sin6);
1342 if (bind(sk, &s.sa, slen) < 0) {
1343 connman_error("Failed to bind %s listener socket", proto);
1348 if (protocol == IPPROTO_TCP && listen(sk, 10) < 0) {
1349 connman_error("Failed to listen on TCP socket");
1354 channel = g_io_channel_unix_new(sk);
1355 if (channel == NULL) {
1356 connman_error("Failed to create %s listener channel", proto);
1361 g_io_channel_set_close_on_unref(channel, TRUE);
1363 if (protocol == IPPROTO_TCP) {
1364 tcp_listener_channel = channel;
1365 tcp_listener_watch = g_io_add_watch(channel,
1366 G_IO_IN, tcp_listener_event, NULL);
1368 udp_listener_channel = channel;
1369 udp_listener_watch = g_io_add_watch(channel,
1370 G_IO_IN, udp_listener_event, NULL);
1376 static void destroy_udp_listener(void)
1380 if (udp_listener_watch > 0)
1381 g_source_remove(udp_listener_watch);
1383 g_io_channel_unref(udp_listener_channel);
1386 static void destroy_tcp_listener(void)
1390 if (tcp_listener_watch > 0)
1391 g_source_remove(tcp_listener_watch);
1393 g_io_channel_unref(tcp_listener_channel);
1396 static int create_listener(void)
1400 err = create_dns_listener(IPPROTO_UDP);
1404 err = create_dns_listener(IPPROTO_TCP);
1406 destroy_udp_listener();
1410 __connman_resolvfile_append("lo", NULL, "127.0.0.1");
1415 static void destroy_listener(void)
1419 __connman_resolvfile_remove("lo", NULL, "127.0.0.1");
1421 for (list = request_pending_list; list; list = list->next) {
1422 struct request_data *req = list->data;
1424 DBG("Dropping pending request (id 0x%04x -> 0x%04x)",
1425 req->srcid, req->dstid);
1428 g_free(req->request);
1434 g_slist_free(request_pending_list);
1435 request_pending_list = NULL;
1437 for (list = request_list; list; list = list->next) {
1438 struct request_data *req = list->data;
1440 DBG("Dropping request (id 0x%04x -> 0x%04x)",
1441 req->srcid, req->dstid);
1444 g_free(req->request);
1450 g_slist_free(request_list);
1451 request_list = NULL;
1453 destroy_tcp_listener();
1454 destroy_udp_listener();
1457 int __connman_dnsproxy_init(void)
1463 err = create_listener();
1467 err = connman_notifier_register(&dnsproxy_notifier);
1479 void __connman_dnsproxy_cleanup(void)
1483 connman_notifier_unregister(&dnsproxy_notifier);