Index: fusl/src/network/res_msend.c |
diff --git a/fusl/src/network/res_msend.c b/fusl/src/network/res_msend.c |
new file mode 100644 |
index 0000000000000000000000000000000000000000..d0e8e4815d0d87cfa44be2d845d0367913059cea |
--- /dev/null |
+++ b/fusl/src/network/res_msend.c |
@@ -0,0 +1,218 @@ |
+#include <sys/socket.h> |
+#include <netinet/in.h> |
+#include <netdb.h> |
+#include <arpa/inet.h> |
+#include <stdint.h> |
+#include <string.h> |
+#include <poll.h> |
+#include <time.h> |
+#include <ctype.h> |
+#include <unistd.h> |
+#include <errno.h> |
+#include <pthread.h> |
+#include "stdio_impl.h" |
+#include "syscall.h" |
+#include "lookup.h" |
+ |
+static void cleanup(void *p) |
+{ |
+ __syscall(SYS_close, (intptr_t)p); |
+} |
+ |
+static unsigned long mtime() |
+{ |
+ struct timespec ts; |
+ clock_gettime(CLOCK_REALTIME, &ts); |
+ return (unsigned long)ts.tv_sec * 1000 |
+ + ts.tv_nsec / 1000000; |
+} |
+ |
+int __res_msend(int nqueries, const unsigned char *const *queries, |
+ const int *qlens, unsigned char *const *answers, int *alens, int asize) |
+{ |
+ int fd; |
+ FILE *f, _f; |
+ unsigned char _buf[256]; |
+ char line[64], *s, *z; |
+ int timeout = 5000, attempts = 2, retry_interval, servfail_retry; |
+ union { |
+ struct sockaddr_in sin; |
+ struct sockaddr_in6 sin6; |
+ } sa = {0}, ns[3] = {{0}}; |
+ socklen_t sl = sizeof sa.sin; |
+ int nns = 0; |
+ int family = AF_INET; |
+ int rlen; |
+ int next; |
+ int i, j; |
+ int cs; |
+ struct pollfd pfd; |
+ unsigned long t0, t1, t2; |
+ struct address iplit; |
+ |
+ pthread_setcancelstate(PTHREAD_CANCEL_DISABLE, &cs); |
+ |
+ /* Get nameservers from resolv.conf, fallback to localhost */ |
+ f = __fopen_rb_ca("/etc/resolv.conf", &_f, _buf, sizeof _buf); |
+ if (!f) switch (errno) { |
+ case ENOENT: |
+ case ENOTDIR: |
+ case EACCES: |
+ goto no_resolv_conf; |
+ default: |
+ return -1; |
+ } |
+ for (nns=0; nns<3 && fgets(line, sizeof line, f); ) { |
+ if (!strncmp(line, "options", 7) && isspace(line[7])) { |
+ unsigned long x; |
+ char *p, *z; |
+ p = strstr(line, "timeout:"); |
+ if (p && isdigit(p[8])) { |
+ p += 8; |
+ x = strtoul(p, &z, 10); |
+ if (z != p) timeout = x < 30 ? x*1000 : 30000; |
+ } |
+ p = strstr(line, "attempts:"); |
+ if (p && isdigit(p[9])) { |
+ p += 9; |
+ x = strtoul(p, &z, 10); |
+ if (z != p) attempts = x < 10 ? x : 10; |
+ if (!attempts) attempts = 1; |
+ } |
+ } |
+ if (strncmp(line, "nameserver", 10) || !isspace(line[10])) |
+ continue; |
+ for (s=line+11; isspace(*s); s++); |
+ for (z=s; *z && !isspace(*z); z++); |
+ *z=0; |
+ |
+ if (__lookup_ipliteral(&iplit, s, AF_UNSPEC)>0) { |
+ if (iplit.family == AF_INET) { |
+ memcpy(&ns[nns].sin.sin_addr, iplit.addr, 4); |
+ ns[nns].sin.sin_port = htons(53); |
+ ns[nns++].sin.sin_family = AF_INET; |
+ } else { |
+ sl = sizeof sa.sin6; |
+ memcpy(&ns[nns].sin6.sin6_addr, iplit.addr, 16); |
+ ns[nns].sin6.sin6_port = htons(53); |
+ ns[nns].sin6.sin6_scope_id = iplit.scopeid; |
+ ns[nns++].sin6.sin6_family = family = AF_INET6; |
+ } |
+ } |
+ } |
+ __fclose_ca(f); |
+no_resolv_conf: |
+ if (!nns) { |
+ ns[0].sin.sin_family = AF_INET; |
+ ns[0].sin.sin_port = htons(53); |
+ ns[0].sin.sin_addr.s_addr = htonl(0x7f000001); |
+ nns=1; |
+ } |
+ |
+ /* Get local address and open/bind a socket */ |
+ sa.sin.sin_family = family; |
+ fd = socket(family, SOCK_DGRAM|SOCK_CLOEXEC|SOCK_NONBLOCK, 0); |
+ |
+ /* Handle case where system lacks IPv6 support */ |
+ if (fd < 0 && family == AF_INET6 && errno == EAFNOSUPPORT) { |
+ fd = socket(AF_INET, SOCK_DGRAM|SOCK_CLOEXEC|SOCK_NONBLOCK, 0); |
+ family = AF_INET; |
+ } |
+ if (fd < 0 || bind(fd, (void *)&sa, sl) < 0) return -1; |
+ |
+ /* Past this point, there are no errors. Each individual query will |
+ * yield either no reply (indicated by zero length) or an answer |
+ * packet which is up to the caller to interpret. */ |
+ |
+ pthread_cleanup_push(cleanup, (void *)(intptr_t)fd); |
+ pthread_setcancelstate(cs, 0); |
+ |
+ /* Convert any IPv4 addresses in a mixed environment to v4-mapped */ |
+ if (family == AF_INET6) { |
+ setsockopt(fd, IPPROTO_IPV6, IPV6_V6ONLY, &(int){0}, sizeof 0); |
+ for (i=0; i<nns; i++) { |
+ if (ns[i].sin.sin_family != AF_INET) continue; |
+ memcpy(ns[i].sin6.sin6_addr.s6_addr+12, |
+ &ns[i].sin.sin_addr, 4); |
+ memcpy(ns[i].sin6.sin6_addr.s6_addr, |
+ "\0\0\0\0\0\0\0\0\0\0\xff\xff", 12); |
+ ns[i].sin6.sin6_family = AF_INET6; |
+ ns[i].sin6.sin6_flowinfo = 0; |
+ ns[i].sin6.sin6_scope_id = 0; |
+ } |
+ } |
+ |
+ memset(alens, 0, sizeof *alens * nqueries); |
+ |
+ pfd.fd = fd; |
+ pfd.events = POLLIN; |
+ retry_interval = timeout / attempts; |
+ next = 0; |
+ t0 = t2 = mtime(); |
+ t1 = t2 - retry_interval; |
+ |
+ for (; t2-t0 < timeout; t2=mtime()) { |
+ if (t2-t1 >= retry_interval) { |
+ /* Query all configured namservers in parallel */ |
+ for (i=0; i<nqueries; i++) |
+ if (!alens[i]) |
+ for (j=0; j<nns; j++) |
+ sendto(fd, queries[i], |
+ qlens[i], MSG_NOSIGNAL, |
+ (void *)&ns[j], sl); |
+ t1 = t2; |
+ servfail_retry = 2 * nqueries; |
+ } |
+ |
+ /* Wait for a response, or until time to retry */ |
+ if (poll(&pfd, 1, t1+retry_interval-t2) <= 0) continue; |
+ |
+ while ((rlen = recvfrom(fd, answers[next], asize, 0, |
+ (void *)&sa, (socklen_t[1]){sl})) >= 0) { |
+ |
+ /* Ignore non-identifiable packets */ |
+ if (rlen < 4) continue; |
+ |
+ /* Ignore replies from addresses we didn't send to */ |
+ for (j=0; j<nns && memcmp(ns+j, &sa, sl); j++); |
+ if (j==nns) continue; |
+ |
+ /* Find which query this answer goes with, if any */ |
+ for (i=next; i<nqueries && ( |
+ answers[next][0] != queries[i][0] || |
+ answers[next][1] != queries[i][1] ); i++); |
+ if (i==nqueries) continue; |
+ if (alens[i]) continue; |
+ |
+ /* Only accept positive or negative responses; |
+ * retry immediately on server failure, and ignore |
+ * all other codes such as refusal. */ |
+ switch (answers[next][3] & 15) { |
+ case 0: |
+ case 3: |
+ break; |
+ case 2: |
+ if (servfail_retry && servfail_retry--) |
+ sendto(fd, queries[i], |
+ qlens[i], MSG_NOSIGNAL, |
+ (void *)&ns[j], sl); |
+ default: |
+ continue; |
+ } |
+ |
+ /* Store answer in the right slot, or update next |
+ * available temp slot if it's already in place. */ |
+ alens[i] = rlen; |
+ if (i == next) |
+ for (; next<nqueries && alens[next]; next++); |
+ else |
+ memcpy(answers[i], answers[next], rlen); |
+ |
+ if (next == nqueries) goto out; |
+ } |
+ } |
+out: |
+ pthread_cleanup_pop(1); |
+ |
+ return 0; |
+} |