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>
38 #define CONNMAN_API_SUBJECT_TO_CHANGE
39 #include <connman/ondemand.h>
43 #if __BYTE_ORDER == __LITTLE_ENDIAN
58 } __attribute__ ((packed));
59 #elif __BYTE_ORDER == __BIG_ENDIAN
74 } __attribute__ ((packed));
76 #error "Unknown byte order"
79 struct partial_reply {
95 struct partial_reply *incoming_reply;
100 struct sockaddr_in6 __sin6; /* Only for the length */
120 static connman_bool_t dnsproxy_enabled = TRUE;
121 static GSList *server_list = NULL;
122 static GSList *request_list = NULL;
123 static GSList *request_pending_list = NULL;
124 static guint16 request_id = 0x0000;
126 static GIOChannel *udp_listener_channel = NULL;
127 static guint udp_listener_watch = 0;
128 static GIOChannel *tcp_listener_channel = NULL;
129 static guint tcp_listener_watch = 0;
131 static int protocol_offset(int protocol)
146 static struct request_data *find_request(guint16 id)
150 for (list = request_list; list; list = list->next) {
151 struct request_data *req = list->data;
153 if (req->dstid == id || req->altid == id)
160 static struct server_data *find_server(const char *interface,
166 DBG("interface %s server %s", interface, server);
168 for (list = server_list; list; list = list->next) {
169 struct server_data *data = list->data;
171 if (data->interface == NULL || data->server == NULL)
174 if (g_str_equal(data->interface, interface) == TRUE &&
175 g_str_equal(data->server, server) == TRUE &&
176 data->protocol == protocol)
184 static void send_response(int sk, unsigned char *buf, int len,
185 const struct sockaddr *to, socklen_t tolen,
188 struct domain_hdr *hdr;
189 int err, offset = protocol_offset(protocol);
199 hdr = (void *) (buf + offset);
201 DBG("id 0x%04x qr %d opcode %d", hdr->id, hdr->qr, hdr->opcode);
210 err = sendto(sk, buf, len, 0, to, tolen);
213 static gboolean request_timeout(gpointer user_data)
215 struct request_data *req = user_data;
217 DBG("id 0x%04x", req->srcid);
222 request_list = g_slist_remove(request_list, req);
225 if (req->resplen > 0 && req->resp != NULL) {
228 sk = g_io_channel_unix_get_fd(udp_listener_channel);
230 err = sendto(sk, req->resp, req->resplen, 0,
231 &req->sa, req->sa_len);
232 } else if (req->request && req->numserv == 0) {
233 struct domain_hdr *hdr;
235 if (req->protocol == IPPROTO_TCP) {
236 hdr = (void *) (req->request + 2);
237 hdr->id = req->srcid;
238 send_response(req->client_sk, req->request,
239 req->request_len, NULL, 0, IPPROTO_TCP);
241 } else if (req->protocol == IPPROTO_UDP) {
244 hdr = (void *) (req->request);
245 hdr->id = req->srcid;
246 sk = g_io_channel_unix_get_fd(udp_listener_channel);
247 send_response(sk, req->request, req->request_len,
248 &req->sa, req->sa_len, IPPROTO_UDP);
258 static int append_query(unsigned char *buf, unsigned int size,
259 const char *query, const char *domain)
261 unsigned char *ptr = buf;
264 DBG("query %s domain %s", query, domain);
266 offset = (char *) query;
267 while (offset != NULL) {
270 tmp = strchr(offset, '.');
272 if (strlen(offset) == 0)
274 *ptr = strlen(offset);
275 memcpy(ptr + 1, offset, strlen(offset));
276 ptr += strlen(offset) + 1;
281 memcpy(ptr + 1, offset, tmp - offset);
282 ptr += tmp - offset + 1;
287 offset = (char *) domain;
288 while (offset != NULL) {
291 tmp = strchr(offset, '.');
293 if (strlen(offset) == 0)
295 *ptr = strlen(offset);
296 memcpy(ptr + 1, offset, strlen(offset));
297 ptr += strlen(offset) + 1;
302 memcpy(ptr + 1, offset, tmp - offset);
303 ptr += tmp - offset + 1;
313 static int ns_resolv(struct server_data *server, struct request_data *req,
314 gpointer request, gpointer name)
319 sk = g_io_channel_unix_get_fd(server->channel);
321 err = send(sk, request, req->request_len, 0);
325 for (list = server->domains; list; list = list->next) {
327 unsigned char alt[1024];
328 struct domain_hdr *hdr = (void *) &alt;
329 int altlen, domlen, offset;
336 offset = protocol_offset(server->protocol);
340 domlen = strlen(domain) + 1;
344 alt[offset] = req->altid & 0xff;
345 alt[offset + 1] = req->altid >> 8;
347 memcpy(alt + offset + 2, request + offset + 2, 10);
348 hdr->qdcount = htons(1);
350 altlen = append_query(alt + offset + 12, sizeof(alt) - 12,
357 memcpy(alt + offset + altlen,
358 request + offset + altlen - domlen,
359 req->request_len - altlen + domlen);
361 if (server->protocol == IPPROTO_TCP) {
362 int req_len = req->request_len + domlen - 1;
364 alt[0] = (req_len >> 8) & 0xff;
365 alt[1] = req_len & 0xff;
368 err = send(sk, alt, req->request_len + domlen + 1, 0);
376 static int forward_dns_reply(unsigned char *reply, int reply_len, int protocol)
378 struct domain_hdr *hdr;
379 struct request_data *req;
380 int dns_id, sk, err, offset = protocol_offset(protocol);
385 hdr = (void *)(reply + offset);
386 dns_id = reply[offset] | reply[offset + 1] << 8;
388 DBG("Received %d bytes (id 0x%04x)", reply_len, dns_id);
390 req = find_request(dns_id);
394 DBG("id 0x%04x rcode %d", hdr->id, hdr->rcode);
396 reply[offset] = req->srcid & 0xff;
397 reply[offset + 1] = req->srcid >> 8;
401 if (hdr->rcode == 0 || req->resp == NULL) {
405 req->resp = g_try_malloc(reply_len);
406 if (req->resp == NULL)
409 memcpy(req->resp, reply, reply_len);
410 req->resplen = reply_len;
413 if (hdr->rcode > 0 && req->numresp < req->numserv)
416 if (req->timeout > 0)
417 g_source_remove(req->timeout);
419 request_list = g_slist_remove(request_list, req);
421 if (protocol == IPPROTO_UDP) {
422 sk = g_io_channel_unix_get_fd(udp_listener_channel);
423 err = sendto(sk, req->resp, req->resplen, 0,
424 &req->sa, req->sa_len);
427 err = send(sk, req->resp, req->resplen, 0);
437 static void destroy_server(struct server_data *server)
441 DBG("interface %s server %s", server->interface, server->server);
443 server_list = g_slist_remove(server_list, server);
445 if (server->watch > 0)
446 g_source_remove(server->watch);
448 if (server->timeout > 0)
449 g_source_remove(server->timeout);
451 g_io_channel_unref(server->channel);
453 if (server->protocol == IPPROTO_UDP)
454 connman_info("Removing DNS server %s", server->server);
456 g_free(server->incoming_reply);
457 g_free(server->server);
458 for (list = server->domains; list; list = list->next) {
459 char *domain = list->data;
461 server->domains = g_list_remove(server->domains, domain);
464 g_free(server->interface);
468 static gboolean udp_server_event(GIOChannel *channel, GIOCondition condition,
471 unsigned char buf[4096];
474 if (condition & (G_IO_NVAL | G_IO_ERR | G_IO_HUP)) {
475 struct server_data *data = user_data;
477 connman_error("Error with UDP server %s", data->server);
482 sk = g_io_channel_unix_get_fd(channel);
484 len = recv(sk, buf, sizeof(buf), 0);
488 err = forward_dns_reply(buf, len, IPPROTO_UDP);
493 static gboolean tcp_server_event(GIOChannel *channel, GIOCondition condition,
497 struct server_data *server = user_data;
499 sk = g_io_channel_unix_get_fd(channel);
503 if (condition & (G_IO_NVAL | G_IO_ERR | G_IO_HUP)) {
506 DBG("TCP server channel closed");
509 * Discard any partial response which is buffered; better
510 * to get a proper response from a working server.
512 g_free(server->incoming_reply);
513 server->incoming_reply = NULL;
515 for (list = request_list; list; list = list->next) {
516 struct request_data *req = list->data;
517 struct domain_hdr *hdr;
519 if (req->protocol == IPPROTO_UDP)
522 if (req->request == NULL)
526 * If we're not waiting for any further response
527 * from another name server, then we send an error
528 * response to the client.
530 if (req->numserv && --(req->numserv))
533 hdr = (void *) (req->request + 2);
534 hdr->id = req->srcid;
535 send_response(req->client_sk, req->request,
536 req->request_len, NULL, 0, IPPROTO_TCP);
538 request_list = g_slist_remove(request_list, req);
541 destroy_server(server);
546 if ((condition & G_IO_OUT) && !server->connected) {
549 struct server_data *udp_server;
551 udp_server = find_server(server->interface, server->server,
553 if (udp_server != NULL) {
554 for (domains = udp_server->domains; domains;
555 domains = domains->next) {
556 char *dom = domains->data;
558 DBG("Adding domain %s to %s",
559 dom, server->server);
561 server->domains = g_list_append(server->domains,
566 server->connected = TRUE;
567 server_list = g_slist_append(server_list, server);
569 if (server->timeout > 0) {
570 g_source_remove(server->timeout);
574 for (list = request_list; list; list = list->next) {
575 struct request_data *req = list->data;
577 if (req->protocol == IPPROTO_UDP)
580 DBG("Sending req %s over TCP", (char *)req->name);
582 if (req->timeout > 0)
583 g_source_remove(req->timeout);
585 req->timeout = g_timeout_add_seconds(30,
586 request_timeout, req);
587 ns_resolv(server, req, req->request, req->name);
590 } else if (condition & G_IO_IN) {
591 struct partial_reply *reply = server->incoming_reply;
595 unsigned char reply_len_buf[2];
598 bytes_recv = recv(sk, reply_len_buf, 2, MSG_PEEK);
601 } else if (bytes_recv < 0) {
602 if (errno == EAGAIN || errno == EWOULDBLOCK)
605 connman_error("DNS proxy error %s",
608 } else if (bytes_recv < 2)
611 reply_len = reply_len_buf[1] | reply_len_buf[0] << 8;
614 DBG("TCP reply %d bytes", reply_len);
616 reply = g_try_malloc(sizeof(*reply) + reply_len + 2);
620 reply->len = reply_len;
623 server->incoming_reply = reply;
626 while (reply->received < reply->len) {
627 bytes_recv = recv(sk, reply->buf + reply->received,
628 reply->len - reply->received, 0);
630 connman_error("DNS proxy TCP disconnect");
632 } else if (bytes_recv < 0) {
633 if (errno == EAGAIN || errno == EWOULDBLOCK)
636 connman_error("DNS proxy error %s",
640 reply->received += bytes_recv;
643 forward_dns_reply(reply->buf, reply->received, IPPROTO_TCP);
646 server->incoming_reply = NULL;
648 destroy_server(server);
656 static gboolean tcp_idle_timeout(gpointer user_data)
658 struct server_data *server = user_data;
665 destroy_server(server);
670 static struct server_data *create_server(const char *interface,
671 const char *domain, const char *server,
674 struct addrinfo hints, *rp;
675 struct server_data *data;
678 DBG("interface %s server %s", interface, server);
680 memset(&hints, 0, sizeof(hints));
684 hints.ai_socktype = SOCK_DGRAM;
688 hints.ai_socktype = SOCK_STREAM;
694 hints.ai_family = AF_UNSPEC;
695 hints.ai_flags = AI_PASSIVE | AI_NUMERICSERV | AI_NUMERICHOST;
697 ret = getaddrinfo(server, "53", &hints, &rp);
699 connman_error("Failed to parse server %s address: %s\n",
700 server, gai_strerror(ret));
703 /* Do not blindly copy this code elsewhere; it doesn't loop over the
704 results using ->ai_next as it should. That's OK in *this* case
705 because it was a numeric lookup; we *know* there's only one. */
707 sk = socket(rp->ai_family, rp->ai_socktype, rp->ai_protocol);
709 connman_error("Failed to create server %s socket", server);
714 if (interface != NULL) {
715 if (setsockopt(sk, SOL_SOCKET, SO_BINDTODEVICE,
716 interface, strlen(interface) + 1) < 0) {
717 connman_error("Failed to bind server %s "
726 data = g_try_new0(struct server_data, 1);
728 connman_error("Failed to allocate server %s data", server);
734 data->channel = g_io_channel_unix_new(sk);
735 if (data->channel == NULL) {
736 connman_error("Failed to create server %s channel", server);
743 g_io_channel_set_close_on_unref(data->channel, TRUE);
745 if (protocol == IPPROTO_TCP) {
746 g_io_channel_set_flags(data->channel, G_IO_FLAG_NONBLOCK, NULL);
747 data->watch = g_io_add_watch(data->channel,
748 G_IO_OUT | G_IO_IN | G_IO_HUP | G_IO_NVAL | G_IO_ERR,
749 tcp_server_event, data);
750 data->timeout = g_timeout_add_seconds(30, tcp_idle_timeout,
753 data->watch = g_io_add_watch(data->channel,
754 G_IO_IN | G_IO_NVAL | G_IO_ERR | G_IO_HUP,
755 udp_server_event, data);
757 data->interface = g_strdup(interface);
759 data->domains = g_list_append(data->domains, g_strdup(domain));
760 data->server = g_strdup(server);
761 data->protocol = protocol;
763 ret = connect(sk, rp->ai_addr, rp->ai_addrlen);
766 if ((protocol == IPPROTO_TCP && errno != EINPROGRESS) ||
767 protocol == IPPROTO_UDP) {
770 connman_error("Failed to connect to server %s", server);
772 g_source_remove(data->watch);
773 if (data->timeout > 0)
774 g_source_remove(data->timeout);
776 g_io_channel_unref(data->channel);
779 g_free(data->server);
780 g_free(data->interface);
781 for (list = data->domains; list; list = list->next) {
782 char *domain = list->data;
784 data->domains = g_list_remove(data->domains,
793 if (protocol == IPPROTO_UDP) {
794 /* Enable new servers by default */
795 data->enabled = TRUE;
796 connman_info("Adding DNS server %s", data->server);
798 server_list = g_slist_append(server_list, data);
806 static gboolean resolv(struct request_data *req,
807 gpointer request, gpointer name)
811 for (list = server_list; list; list = list->next) {
812 struct server_data *data = list->data;
814 DBG("server %s enabled %d", data->server, data->enabled);
816 if (data->enabled == FALSE)
819 if (data->watch == 0 && data->protocol == IPPROTO_UDP)
820 data->watch = g_io_add_watch(data->channel,
821 G_IO_IN | G_IO_NVAL | G_IO_ERR | G_IO_HUP,
822 udp_server_event, data);
824 if (ns_resolv(data, req, request, name) < 0)
831 static void append_domain(const char *interface, const char *domain)
835 DBG("interface %s domain %s", interface, domain);
837 for (list = server_list; list; list = list->next) {
838 struct server_data *data = list->data;
841 gboolean dom_found = FALSE;
843 if (data->interface == NULL)
846 if (g_str_equal(data->interface, interface) == FALSE)
849 for (dom_list = data->domains; dom_list;
850 dom_list = dom_list->next) {
851 dom = dom_list->data;
853 if (g_str_equal(dom, domain)) {
859 if (dom_found == FALSE) {
861 g_list_append(data->domains, g_strdup(domain));
866 static int dnsproxy_append(const char *interface, const char *domain,
869 struct server_data *data;
871 DBG("interface %s server %s", interface, server);
873 if (server == NULL && domain == NULL)
876 if (server == NULL) {
877 append_domain(interface, domain);
882 if (g_str_equal(server, "127.0.0.1") == TRUE)
885 data = find_server(interface, server, IPPROTO_UDP);
887 append_domain(interface, domain);
891 data = create_server(interface, domain, server, IPPROTO_UDP);
898 static void remove_server(const char *interface, const char *domain,
899 const char *server, int protocol)
901 struct server_data *data;
903 data = find_server(interface, server, protocol);
907 destroy_server(data);
910 static int dnsproxy_remove(const char *interface, const char *domain,
913 DBG("interface %s server %s", interface, server);
918 if (g_str_equal(server, "127.0.0.1") == TRUE)
921 remove_server(interface, domain, server, IPPROTO_UDP);
922 remove_server(interface, domain, server, IPPROTO_TCP);
927 static void dnsproxy_flush(void)
931 list = request_pending_list;
933 struct request_data *req = list->data;
937 request_pending_list =
938 g_slist_remove(request_pending_list, req);
939 resolv(req, req->request, req->name);
940 g_free(req->request);
945 static struct connman_resolver dnsproxy_resolver = {
947 .priority = CONNMAN_RESOLVER_PRIORITY_HIGH,
948 .append = dnsproxy_append,
949 .remove = dnsproxy_remove,
950 .flush = dnsproxy_flush,
953 static void dnsproxy_offline_mode(connman_bool_t enabled)
957 DBG("enabled %d", enabled);
959 for (list = server_list; list; list = list->next) {
960 struct server_data *data = list->data;
962 if (enabled == FALSE) {
963 connman_info("Enabling DNS server %s", data->server);
964 data->enabled = TRUE;
966 connman_info("Disabling DNS server %s", data->server);
967 data->enabled = FALSE;
972 static void dnsproxy_default_changed(struct connman_service *service)
977 DBG("service %p", service);
979 if (service == NULL) {
980 /* When no services are active, then disable DNS proxying */
981 dnsproxy_offline_mode(TRUE);
985 interface = connman_service_get_interface(service);
986 if (interface == NULL)
989 for (list = server_list; list; list = list->next) {
990 struct server_data *data = list->data;
992 if (g_strcmp0(data->interface, interface) == 0) {
993 connman_info("Enabling DNS server %s", data->server);
994 data->enabled = TRUE;
996 connman_info("Disabling DNS server %s", data->server);
997 data->enabled = FALSE;
1004 static struct connman_notifier dnsproxy_notifier = {
1006 .default_changed = dnsproxy_default_changed,
1007 .offline_mode = dnsproxy_offline_mode,
1010 static unsigned char opt_edns0_type[2] = { 0x00, 0x29 };
1012 static int parse_request(unsigned char *buf, int len,
1013 char *name, unsigned int size)
1015 struct domain_hdr *hdr = (void *) buf;
1016 uint16_t qdcount = ntohs(hdr->qdcount);
1017 uint16_t arcount = ntohs(hdr->arcount);
1019 char *last_label = NULL;
1020 unsigned int remain, used = 0;
1025 DBG("id 0x%04x qr %d opcode %d qdcount %d arcount %d",
1026 hdr->id, hdr->qr, hdr->opcode,
1029 if (hdr->qr != 0 || qdcount != 1)
1032 memset(name, 0, size);
1034 ptr = buf + sizeof(struct domain_hdr);
1035 remain = len - sizeof(struct domain_hdr);
1037 while (remain > 0) {
1041 last_label = (char *) (ptr + 1);
1045 if (used + len + 1 > size)
1048 strncat(name, (char *) (ptr + 1), len);
1057 if (last_label && arcount && remain >= 9 && last_label[4] == 0 &&
1058 !memcmp(last_label + 5, opt_edns0_type, 2)) {
1059 uint16_t edns0_bufsize;
1061 edns0_bufsize = last_label[7] << 8 | last_label[8];
1063 DBG("EDNS0 buffer size %u", edns0_bufsize);
1065 /* This is an evil hack until full TCP support has been
1068 * Somtimes the EDNS0 request gets send with a too-small
1069 * buffer size. Since glibc doesn't seem to crash when it
1070 * gets a response biffer then it requested, just bump
1071 * the buffer size up to 4KiB.
1073 if (edns0_bufsize < 0x1000) {
1074 last_label[7] = 0x10;
1075 last_label[8] = 0x00;
1079 DBG("query %s", name);
1084 static gboolean tcp_listener_event(GIOChannel *channel, GIOCondition condition,
1087 unsigned char buf[768];
1089 struct request_data *req;
1090 struct server_data *server;
1091 int sk, client_sk, len, err;
1092 struct sockaddr_in6 client_addr;
1093 socklen_t client_addr_len = sizeof(client_addr);
1096 DBG("condition 0x%x", condition);
1098 if (condition & (G_IO_NVAL | G_IO_ERR | G_IO_HUP)) {
1099 if (tcp_listener_watch > 0)
1100 g_source_remove(tcp_listener_watch);
1101 tcp_listener_watch = 0;
1103 connman_error("Error with TCP listener channel");
1108 sk = g_io_channel_unix_get_fd(channel);
1110 client_sk = accept(sk, (void *)&client_addr, &client_addr_len);
1111 if (client_sk < 0) {
1112 connman_error("Accept failure on TCP listener");
1113 tcp_listener_watch = 0;
1117 len = recv(client_sk, buf, sizeof(buf), 0);
1121 DBG("Received %d bytes (id 0x%04x)", len, buf[2] | buf[3] << 8);
1123 err = parse_request(buf + 2, len - 2, query, sizeof(query));
1124 if (err < 0 || (g_slist_length(server_list) == 0 &&
1125 connman_ondemand_connected())) {
1126 send_response(client_sk, buf, len, NULL, 0, IPPROTO_TCP);
1130 req = g_try_new0(struct request_data, 1);
1134 memcpy(&req->sa, &client_addr, client_addr_len);
1135 req->sa_len = client_addr_len;
1136 req->client_sk = client_sk;
1137 req->protocol = IPPROTO_TCP;
1140 if (request_id == 0x0000 || request_id == 0xffff)
1143 req->srcid = buf[2] | (buf[3] << 8);
1144 req->dstid = request_id;
1145 req->altid = request_id + 1;
1146 req->request_len = len;
1148 buf[2] = req->dstid & 0xff;
1149 buf[3] = req->dstid >> 8;
1152 request_list = g_slist_append(request_list, req);
1154 for (list = server_list; list; list = list->next) {
1155 struct server_data *data = list->data;
1158 if (data->protocol != IPPROTO_UDP || data->enabled == FALSE)
1161 server = create_server(data->interface, NULL,
1162 data->server, IPPROTO_TCP);
1165 * If server is NULL, we're not connected yet.
1166 * Copy the relevant buffers and continue with
1167 * the next nameserver.
1168 * The request will actually be sent once we're
1169 * properly connected over TCP to this nameserver.
1171 if (server == NULL) {
1172 req->request = g_try_malloc0(req->request_len);
1173 if (req->request == NULL)
1176 memcpy(req->request, buf, req->request_len);
1178 req->name = g_try_malloc0(sizeof(query));
1179 if (req->name == NULL) {
1180 g_free(req->request);
1183 memcpy(req->name, query, sizeof(query));
1188 if (req->timeout > 0)
1189 g_source_remove(req->timeout);
1191 for (domains = data->domains; domains;
1192 domains = domains->next) {
1193 char *dom = domains->data;
1195 DBG("Adding domain %s to %s", dom, server->server);
1197 server->domains = g_list_append(server->domains,
1201 req->timeout = g_timeout_add_seconds(30, request_timeout, req);
1202 ns_resolv(server, req, buf, query);
1208 static gboolean udp_listener_event(GIOChannel *channel, GIOCondition condition,
1211 unsigned char buf[768];
1213 struct request_data *req;
1214 struct sockaddr_in6 client_addr;
1215 socklen_t client_addr_len = sizeof(client_addr);
1218 if (condition & (G_IO_NVAL | G_IO_ERR | G_IO_HUP)) {
1219 connman_error("Error with UDP listener channel");
1220 udp_listener_watch = 0;
1224 sk = g_io_channel_unix_get_fd(channel);
1226 memset(&client_addr, 0, client_addr_len);
1227 len = recvfrom(sk, buf, sizeof(buf), 0, (void *)&client_addr,
1232 DBG("Received %d bytes (id 0x%04x)", len, buf[0] | buf[1] << 8);
1234 err = parse_request(buf, len, query, sizeof(query));
1235 if (err < 0 || (g_slist_length(server_list) == 0 &&
1236 connman_ondemand_connected())) {
1237 send_response(sk, buf, len, (void *)&client_addr,
1238 client_addr_len, IPPROTO_UDP);
1242 req = g_try_new0(struct request_data, 1);
1246 memcpy(&req->sa, &client_addr, client_addr_len);
1247 req->sa_len = client_addr_len;
1249 req->protocol = IPPROTO_UDP;
1252 if (request_id == 0x0000 || request_id == 0xffff)
1255 req->srcid = buf[0] | (buf[1] << 8);
1256 req->dstid = request_id;
1257 req->altid = request_id + 1;
1258 req->request_len = len;
1260 buf[0] = req->dstid & 0xff;
1261 buf[1] = req->dstid >> 8;
1263 if (!connman_ondemand_connected()) {
1264 DBG("Starting on demand connection");
1266 * We're not connected, let's queue the request and start
1267 * an on-demand connection.
1269 req->request = g_try_malloc0(req->request_len);
1270 if (req->request == NULL)
1273 memcpy(req->request, buf, req->request_len);
1275 req->name = g_try_malloc0(sizeof(query));
1276 if (req->name == NULL) {
1277 g_free(req->request);
1280 memcpy(req->name, query, sizeof(query));
1282 request_pending_list = g_slist_append(request_pending_list,
1285 connman_ondemand_start("", 300);
1292 req->timeout = g_timeout_add_seconds(5, request_timeout, req);
1293 request_list = g_slist_append(request_list, req);
1295 return resolv(req, buf, query);
1298 static int create_dns_listener(int protocol)
1300 GIOChannel *channel;
1301 const char *ifname = "lo", *proto;
1304 struct sockaddr_in6 sin6;
1305 struct sockaddr_in sin;
1308 int sk, type, v6only = 0;
1309 int family = AF_INET6;
1328 sk = socket(family, type, protocol);
1329 if (sk < 0 && family == AF_INET6 && errno == EAFNOSUPPORT) {
1330 connman_error("No IPv6 support; DNS proxy listening only on Legacy IP");
1332 sk = socket(family, type, protocol);
1335 connman_error("Failed to create %s listener socket", proto);
1339 if (setsockopt(sk, SOL_SOCKET, SO_BINDTODEVICE,
1340 ifname, strlen(ifname) + 1) < 0) {
1341 connman_error("Failed to bind %s listener interface", proto);
1345 /* Ensure it accepts Legacy IP connections too */
1346 if (family == AF_INET6 &&
1347 setsockopt(sk, SOL_IPV6, IPV6_V6ONLY,
1348 &v6only, sizeof(v6only)) < 0) {
1349 connman_error("Failed to clear V6ONLY on %s listener socket",
1355 if (family == AF_INET) {
1356 memset(&s.sin, 0, sizeof(s.sin));
1357 s.sin.sin_family = AF_INET;
1358 s.sin.sin_port = htons(53);
1359 s.sin.sin_addr.s_addr = htonl(INADDR_ANY);
1360 slen = sizeof(s.sin);
1362 memset(&s.sin6, 0, sizeof(s.sin6));
1363 s.sin6.sin6_family = AF_INET6;
1364 s.sin6.sin6_port = htons(53);
1365 s.sin6.sin6_addr = in6addr_any;
1366 slen = sizeof(s.sin6);
1369 if (bind(sk, &s.sa, slen) < 0) {
1370 connman_error("Failed to bind %s listener socket", proto);
1375 if (protocol == IPPROTO_TCP && listen(sk, 10) < 0) {
1376 connman_error("Failed to listen on TCP socket");
1381 channel = g_io_channel_unix_new(sk);
1382 if (channel == NULL) {
1383 connman_error("Failed to create %s listener channel", proto);
1388 g_io_channel_set_close_on_unref(channel, TRUE);
1390 if (protocol == IPPROTO_TCP) {
1391 tcp_listener_channel = channel;
1392 tcp_listener_watch = g_io_add_watch(channel,
1393 G_IO_IN, tcp_listener_event, NULL);
1395 udp_listener_channel = channel;
1396 udp_listener_watch = g_io_add_watch(channel,
1397 G_IO_IN, udp_listener_event, NULL);
1403 static void destroy_udp_listener(void)
1407 if (udp_listener_watch > 0)
1408 g_source_remove(udp_listener_watch);
1410 g_io_channel_unref(udp_listener_channel);
1413 static void destroy_tcp_listener(void)
1417 if (tcp_listener_watch > 0)
1418 g_source_remove(tcp_listener_watch);
1420 g_io_channel_unref(tcp_listener_channel);
1423 static int create_listener(void)
1427 err = create_dns_listener(IPPROTO_UDP);
1431 err = create_dns_listener(IPPROTO_TCP);
1433 destroy_udp_listener();
1437 connman_resolver_append("lo", NULL, "127.0.0.1");
1442 static void destroy_listener(void)
1446 connman_resolver_remove_all("lo");
1448 for (list = request_pending_list; list; list = list->next) {
1449 struct request_data *req = list->data;
1451 DBG("Dropping pending request (id 0x%04x -> 0x%04x)",
1452 req->srcid, req->dstid);
1455 g_free(req->request);
1461 g_slist_free(request_pending_list);
1462 request_pending_list = NULL;
1464 for (list = request_list; list; list = list->next) {
1465 struct request_data *req = list->data;
1467 DBG("Dropping request (id 0x%04x -> 0x%04x)",
1468 req->srcid, req->dstid);
1471 g_free(req->request);
1477 g_slist_free(request_list);
1478 request_list = NULL;
1480 destroy_tcp_listener();
1481 destroy_udp_listener();
1484 int __connman_dnsproxy_init(connman_bool_t dnsproxy)
1488 dnsproxy_enabled = dnsproxy;
1489 if (dnsproxy_enabled == FALSE)
1492 err = create_listener();
1496 err = connman_resolver_register(&dnsproxy_resolver);
1500 err = connman_notifier_register(&dnsproxy_notifier);
1507 connman_resolver_unregister(&dnsproxy_resolver);
1515 void __connman_dnsproxy_cleanup(void)
1517 if (dnsproxy_enabled == FALSE)
1520 connman_notifier_unregister(&dnsproxy_notifier);
1522 connman_resolver_unregister(&dnsproxy_resolver);