__dns.c 6.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282
  1. #include <stdint.h>
  2. #include <netdb.h>
  3. #include <stdio.h>
  4. #include <fcntl.h>
  5. #include <limits.h>
  6. #include <string.h>
  7. #include <sys/socket.h>
  8. #include <poll.h>
  9. #include <netinet/in.h>
  10. #include <time.h>
  11. #include <ctype.h>
  12. #include <unistd.h>
  13. #include <pthread.h>
  14. #include <errno.h>
  15. #include "__dns.h"
  16. #include "stdio_impl.h"
  17. #define TIMEOUT 5
  18. #define RETRY 1000
  19. #define PACKET_MAX 512
  20. #define PTR_MAX (64 + sizeof ".in-addr.arpa")
  21. static void cleanup(void *p)
  22. {
  23. close((intptr_t)p);
  24. }
  25. int __dns_doqueries(unsigned char *dest, const char *name, int *rr, int rrcnt)
  26. {
  27. time_t t0 = time(0);
  28. int fd;
  29. FILE *f, _f;
  30. unsigned char _buf[256];
  31. char line[64], *s, *z;
  32. union {
  33. struct sockaddr_in sin;
  34. struct sockaddr_in6 sin6;
  35. } sa = {0}, ns[3] = {{0}};
  36. socklen_t sl = sizeof sa.sin;
  37. int nns = 0;
  38. int family = AF_INET;
  39. unsigned char q[280] = "", *r = dest;
  40. int ql;
  41. int rlen;
  42. int got = 0, failed = 0;
  43. int errcode = EAI_AGAIN;
  44. int i, j;
  45. struct timespec ts;
  46. struct pollfd pfd;
  47. int id;
  48. int cs;
  49. pthread_setcancelstate(PTHREAD_CANCEL_DISABLE, &cs);
  50. /* Construct query template - RR and ID will be filled later */
  51. if (strlen(name)-1 >= 254U) return EAI_NONAME;
  52. q[2] = q[5] = 1;
  53. strcpy((char *)q+13, name);
  54. for (i=13; q[i]; i=j+1) {
  55. for (j=i; q[j] && q[j] != '.'; j++);
  56. if (j-i-1u > 62u) return EAI_NONAME;
  57. q[i-1] = j-i;
  58. }
  59. q[i+3] = 1;
  60. ql = i+4;
  61. /* Make a reasonably unpredictable id */
  62. clock_gettime(CLOCK_REALTIME, &ts);
  63. id = ts.tv_nsec + ts.tv_nsec/65536UL & 0xffff;
  64. /* Get nameservers from resolv.conf, fallback to localhost */
  65. f = __fopen_rb_ca("/etc/resolv.conf", &_f, _buf, sizeof _buf);
  66. if (f) for (nns=0; nns<3 && fgets(line, sizeof line, f); ) {
  67. if (strncmp(line, "nameserver", 10) || !isspace(line[10]))
  68. continue;
  69. for (s=line+11; isspace(*s); s++);
  70. for (z=s; *z && !isspace(*z); z++);
  71. *z=0;
  72. if (__ipparse(ns+nns, AF_UNSPEC, s) < 0) continue;
  73. ns[nns].sin.sin_port = htons(53);
  74. if (ns[nns++].sin.sin_family == AF_INET6) {
  75. family = AF_INET6;
  76. sl = sizeof sa.sin6;
  77. }
  78. }
  79. if (f) __fclose_ca(f);
  80. if (!nns) {
  81. ns[0].sin.sin_family = family = AF_INET;
  82. ns[0].sin.sin_port = htons(53);
  83. ns[0].sin.sin_addr.s_addr = htonl(0x7f000001);
  84. nns=1;
  85. sl = sizeof sa.sin;
  86. }
  87. /* Get local address and open/bind a socket */
  88. sa.sin.sin_family = family;
  89. fd = socket(family, SOCK_DGRAM|SOCK_CLOEXEC|SOCK_NONBLOCK, 0);
  90. /* Handle case where system lacks IPv6 support */
  91. if (fd < 0 && errno == EAFNOSUPPORT) {
  92. if (family != AF_INET6) return EAI_SYSTEM;
  93. fd = socket(AF_INET, SOCK_DGRAM|SOCK_CLOEXEC|SOCK_NONBLOCK, 0);
  94. family = AF_INET;
  95. }
  96. if (fd < 0) return EAI_SYSTEM;
  97. /* Convert any IPv4 addresses in a mixed environment to v4-mapped */
  98. if (family == AF_INET6) {
  99. setsockopt(fd, IPPROTO_IPV6, IPV6_V6ONLY, &(int){0}, sizeof 0);
  100. for (i=0; i<nns; i++) {
  101. if (ns[i].sin.sin_family != AF_INET) continue;
  102. memcpy(ns[i].sin6.sin6_addr.s6_addr+12,
  103. &ns[i].sin.sin_addr, 4);
  104. memcpy(ns[i].sin6.sin6_addr.s6_addr,
  105. "\0\0\0\0\0\0\0\0\0\0\xff\xff", 12);
  106. ns[i].sin6.sin6_family = AF_INET6;
  107. ns[i].sin6.sin6_flowinfo = 0;
  108. ns[i].sin6.sin6_scope_id = 0;
  109. }
  110. }
  111. pthread_cleanup_push(cleanup, (void *)(intptr_t)fd);
  112. pthread_setcancelstate(cs, 0);
  113. if (bind(fd, (void *)&sa, sl) < 0) {
  114. errcode = EAI_SYSTEM;
  115. goto out;
  116. }
  117. pfd.fd = fd;
  118. pfd.events = POLLIN;
  119. /* Loop until we timeout; break early on success */
  120. for (; time(0)-t0 < TIMEOUT; ) {
  121. /* Query all configured namservers in parallel */
  122. for (i=0; i<rrcnt; i++) if (rr[i]) for (j=0; j<nns; j++) {
  123. q[0] = id+i >> 8;
  124. q[1] = id+i;
  125. q[ql-3] = rr[i];
  126. sendto(fd, q, ql, MSG_NOSIGNAL, (void *)&ns[j], sl);
  127. }
  128. /* Wait for a response, or until time to retry */
  129. if (poll(&pfd, 1, RETRY) <= 0) continue;
  130. /* Process any and all replies */
  131. while (got+failed < rrcnt && (rlen = recvfrom(fd, r, 512, 0,
  132. (void *)&sa, (socklen_t[1]){sl})) >= 2)
  133. {
  134. /* Ignore replies from addresses we didn't send to */
  135. for (i=0; i<nns; i++) if (!memcmp(ns+i, &sa, sl)) break;
  136. if (i==nns) continue;
  137. /* Compute index of the query from id */
  138. i = r[0]*256+r[1] - id & 0xffff;
  139. if ((unsigned)i >= rrcnt || !rr[i]) continue;
  140. /* Interpret the result code */
  141. switch (r[3] & 15) {
  142. case 0:
  143. got++;
  144. break;
  145. case 3:
  146. if (1) errcode = EAI_NONAME; else
  147. default:
  148. errcode = EAI_FAIL;
  149. failed++;
  150. }
  151. /* Mark this record as answered */
  152. rr[i] = 0;
  153. r += 512;
  154. }
  155. /* Check to see if we have answers to all queries */
  156. if (got+failed == rrcnt) break;
  157. }
  158. out:
  159. pthread_cleanup_pop(1);
  160. /* Return the number of results, or an error code if none */
  161. if (got) return got;
  162. return errcode;
  163. }
  164. static void mkptr4(char *s, const unsigned char *ip)
  165. {
  166. sprintf(s, "%d.%d.%d.%d.in-addr.arpa",
  167. ip[3], ip[2], ip[1], ip[0]);
  168. }
  169. static void mkptr6(char *s, const unsigned char *ip)
  170. {
  171. static const char xdigits[] = "0123456789abcdef";
  172. int i;
  173. for (i=15; i>=0; i--) {
  174. *s++ = xdigits[ip[i]&15]; *s++ = '.';
  175. *s++ = xdigits[ip[i]>>4]; *s++ = '.';
  176. }
  177. strcpy(s, "ip6.arpa");
  178. }
  179. int __dns_query(unsigned char *r, const void *a, int family, int ptr)
  180. {
  181. char buf[PTR_MAX];
  182. int rr[2], rrcnt = 1;
  183. if (ptr) {
  184. if (family == AF_INET6) mkptr6(buf, a);
  185. else mkptr4(buf, a);
  186. rr[0] = RR_PTR;
  187. a = buf;
  188. } else if (family == AF_INET6) {
  189. rr[0] = RR_AAAA;
  190. } else {
  191. rr[0] = RR_A;
  192. if (family != AF_INET) rr[rrcnt++] = RR_AAAA;
  193. }
  194. return __dns_doqueries(r, a, rr, rrcnt);
  195. }
  196. int __dn_expand(const unsigned char *, const unsigned char *, const unsigned char *, char *, int);
  197. int __dns_get_rr(void *dest, size_t stride, size_t maxlen, size_t limit, const unsigned char *r, int rr, int dec)
  198. {
  199. int qdcount, ancount;
  200. const unsigned char *p;
  201. char tmp[256];
  202. int found = 0;
  203. int len;
  204. if ((r[3]&15)) return 0;
  205. p = r+12;
  206. qdcount = r[4]*256 + r[5];
  207. ancount = r[6]*256 + r[7];
  208. if (qdcount+ancount > 64) return -1;
  209. while (qdcount--) {
  210. while (p-r < 512 && *p-1U < 127) p++;
  211. if (*p>193 || (*p==193 && p[1]>254) || p>r+506)
  212. return -1;
  213. p += 5 + !!*p;
  214. }
  215. while (ancount--) {
  216. while (p-r < 512 && *p-1U < 127) p++;
  217. if (*p>193 || (*p==193 && p[1]>254) || p>r+506)
  218. return -1;
  219. p += 1 + !!*p;
  220. len = p[8]*256 + p[9];
  221. if (p+len > r+512) return -1;
  222. if (p[1]==rr && len <= maxlen) {
  223. if (dec && __dn_expand(r, r+512, p+10, tmp, sizeof tmp)<0)
  224. return -1;
  225. if (dest && limit) {
  226. if (dec) strcpy(dest, tmp);
  227. else memcpy(dest, p+10, len);
  228. dest = (char *)dest + stride;
  229. limit--;
  230. }
  231. found++;
  232. }
  233. p += 10 + len;
  234. }
  235. return found;
  236. }
  237. int __dns_count_addrs(const unsigned char *r, int cnt)
  238. {
  239. int found=0, res, i;
  240. static const int p[2][2] = { { 4, RR_A }, { 16, RR_AAAA } };
  241. while (cnt--) {
  242. for (i=0; i<2; i++) {
  243. res = __dns_get_rr(0, 0, p[i][0], -1, r, p[i][1], 0);
  244. if (res < 0) return res;
  245. found += res;
  246. }
  247. r += 512;
  248. }
  249. return found;
  250. }