/************************************************************************* * * Copyright (C) 2018 Ruilin Peng (Nick) . * * smartdns is free software: you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation, either version 3 of the License, or * (at your option) any later version. * * smartdns is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program. If not, see . */ #include "dns_server.h" #include "dns.h" #include "list.h" #include "hashtable.h" #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #define DNS_MAX_EVENTS 256 struct dns_server { int run; int epoll_fd; int fd; pthread_mutex_t map_lock; DECLARE_HASHTABLE(hostmap, 6); }; struct dns_request { struct hlist_node map; char host[DNS_MAX_CNAME_LEN]; }; static struct dns_server server; static void tv_sub(struct timeval *out, struct timeval *in) { if ((out->tv_usec -= in->tv_usec) < 0) { /* out -= in */ --out->tv_sec; out->tv_usec += 1000000; } out->tv_sec -= in->tv_sec; } void _dns_server_period_run() { unsigned char packet_data[DNS_PACKSIZE]; unsigned char data[DNS_IN_PACKSIZE]; struct dns_packet *packet = (struct dns_packet *)packet_data; struct dns_head head; memset(&head, 0, sizeof(head)); head.rcode = 0; head.qr = 0; head.rd = 1; head.ra = 0; head.id = 1; int len; struct sockaddr_in to; socklen_t to_len = sizeof(to); dns_packet_init(packet, DNS_PACKSIZE, &head); dns_add_domain(packet, "www.huawei.com", DNS_T_A, 1); len = dns_encode(data, DNS_IN_PACKSIZE, packet); memset(&to, 0, sizeof(to)); to.sin_addr.s_addr = inet_addr("192.168.1.1"); to.sin_port = htons(53); len = sendto(server.fd, data, len, 0, (struct sockaddr *)&to, to_len); if (len < 0) { printf("send failed."); } } static int _dns_server_process(struct timeval *now) { int len; unsigned char inpacket[DNS_IN_PACKSIZE]; unsigned char rsppacket[DNS_PACKSIZE]; unsigned char aswpacket[DNS_PACKSIZE]; unsigned char outpacket[DNS_IN_PACKSIZE]; struct dns_packet *packet = (struct dns_packet *)rsppacket; struct dns_packet *anspacket = (struct dns_packet *)aswpacket; struct sockaddr_storage from; socklen_t from_len = sizeof(from); int data_len; len = recvfrom(server.fd, inpacket, sizeof(inpacket), 0, (struct sockaddr *)&from, (socklen_t *)&from_len); if (len < 0) { fprintf(stderr, "recvfrom failed, %s\n", strerror(errno)); goto errout; } data_len = len; len = dns_decode(packet, DNS_PACKSIZE, inpacket, len); if (len) { printf("decode failed.\n"); return 0; goto errout; } int count; struct dns_rrs *rrs; char name[128]; int i = 0; int j = 0; int ttl; int qtype; int qclass; struct dns_head head; memset(&head, 0, sizeof(head)); head.rcode = 0; head.qr = 1; head.rd = packet->head.rd; head.ra = packet->head.ra; head.id = packet->head.id; int n = 0; dns_packet_init(anspacket, DNS_PACKSIZE, &head); printf("qdcount = %d, ancount = %d, nscount = %d, nrcount = %d, len = %d\n", packet->head.qdcount, packet->head.ancount, packet->head.nscount, packet->head.nrcount, data_len); rrs = dns_get_rrs_start(packet, DNS_RRS_QD, &count); for (i = 0; i < count && rrs; i++, rrs = dns_get_rrs_next(packet, rrs)) { dns_get_domain(rrs, name, 128, &qtype, &qclass); printf("domain: %s qtype: %d qclass: %d\n", name, qtype, qclass); switch (qtype) { case DNS_T_A: { unsigned char addr[4]; addr[0] = 192; addr[1] = 148; addr[2] = 9; addr[3] = 3; dns_add_A(anspacket, DNS_RRS_AN, name, 60 * 60, addr); n++; } break; case DNS_T_AAAA: { unsigned char addr[16]; memset(addr, 0, 16); addr[0] = 1; dns_add_AAAA(anspacket, DNS_RRS_AN, name, 60 * 60, addr); n++; } break; case DNS_T_PTR:{ dns_add_PTR(anspacket, DNS_RRS_AN, name, 60 * 60, "raspberrypi.larva-family.com"); n++; } break; default: break; } } if (n > 0 && packet->head.qr == 0) { dns_add_domain(anspacket, name, qtype, qclass); len = dns_encode(outpacket, DNS_IN_PACKSIZE, anspacket); sendto(server.fd, outpacket, len, 0, (struct sockaddr *)&from, from_len); } for (j = 1; j < DNS_RRS_END; j++) { rrs = dns_get_rrs_start(packet, j, &count); for (i = 0; i < count && rrs; i++, rrs = dns_get_rrs_next(packet, rrs)) { switch (rrs->type) { case DNS_T_A: { unsigned char addr[4]; dns_get_A(rrs, name, 128, &ttl, addr); printf("%s %d : %d.%d.%d.%d\n", name, ttl, addr[0], addr[1], addr[2], addr[3]); } break; case DNS_T_NS: case DNS_T_CNAME: { char cname[128]; dns_get_CNAME(rrs, name, 128, &ttl, cname, 128); printf("%s %d : %s\n", name, ttl, cname); } break; default: break; } } } printf("\n"); return 0; errout: return -1; } int dns_server_run(void) { struct epoll_event events[DNS_MAX_EVENTS + 1]; int num; int i; struct timeval last = {0}; struct timeval now = {0}; struct timeval diff = {0}; uint millisec = 0; while (server.run) { diff = now; tv_sub(&diff, &last); millisec = diff.tv_sec * 1000 + diff.tv_usec / 1000; if (millisec >= 100) { _dns_server_period_run(); last = now; } num = epoll_wait(server.epoll_fd, events, DNS_MAX_EVENTS, 1000); if (num < 0) { gettimeofday(&now, 0); usleep(100000); continue; } if (num == 0) { gettimeofday(&now, 0); continue; } gettimeofday(&now, 0); for (i = 0; i < num; i++) { struct epoll_event *event = &events[i]; if (event->data.fd != server.fd) { fprintf(stderr, "invalid fd\n"); continue; } _dns_server_process(&now); } } close(server.epoll_fd); server.epoll_fd = -1; return 0; } static struct addrinfo *_dns_server_getaddr(const char *host, const char *port, int type, int protocol) { struct addrinfo hints; struct addrinfo *result = NULL; memset(&hints, 0, sizeof(hints)); hints.ai_family = AF_UNSPEC; hints.ai_socktype = type; hints.ai_protocol = protocol; hints.ai_flags = AI_PASSIVE; if (getaddrinfo(host, port, &hints, &result) != 0) { fprintf(stderr, "get addr info failed. %s\n", strerror(errno)); goto errout; } return result; errout: if (result) { freeaddrinfo(result); } return NULL; } int dns_server_start(void) { struct epoll_event event; event.events = EPOLLIN; event.data.fd = server.fd; if (epoll_ctl(server.epoll_fd, EPOLL_CTL_ADD, server.fd, &event) != 0) { fprintf(stderr, "epoll ctl failed."); return -1; } return 0; } int dns_server_socket(void) { int fd = -1; struct addrinfo *gai = NULL; gai = _dns_server_getaddr(NULL, "53", SOCK_DGRAM, 0); if (gai == NULL) { fprintf(stderr, "get address failed.\n"); goto errout; } fd = socket(gai->ai_family, gai->ai_socktype, gai->ai_protocol); if (fd < 0) { fprintf(stderr, "create socket failed.\n"); goto errout; } if (bind(fd, gai->ai_addr, gai->ai_addrlen) != 0) { fprintf(stderr, "bind failed.\n"); goto errout; } server.fd = fd; freeaddrinfo(gai); return fd; errout: if (fd > 0) { close(fd); } if (gai) { freeaddrinfo(gai); } return -1; } int dns_server_init(void) { pthread_attr_t attr; int epollfd = -1; int fd = -1; if (server.epoll_fd > 0) { return -1; } memset(&server, 0, sizeof(server)); pthread_attr_init(&attr); epollfd = epoll_create1(EPOLL_CLOEXEC); if (epollfd < 0) { fprintf(stderr, "create epoll failed, %s\n", strerror(errno)); goto errout; } fd = dns_server_socket(); if (fd < 0) { fprintf(stderr, "create server socket failed.\n"); goto errout; } pthread_mutex_init(&server.map_lock, 0); hash_init(server.hostmap); server.epoll_fd = epollfd; server.fd = fd; server.run = 1; if (dns_server_start() != 0) { fprintf(stderr, "start service failed.\n"); goto errout; } return 0; errout: server.run = 0; if (fd > 0) { close(fd); } if (epollfd) { close(epollfd); } pthread_mutex_destroy(&server.map_lock); return -1; } void dns_server_exit(void) { server.run = 0; if (server.fd > 0) { close(server.fd); server.fd = -1; } pthread_mutex_destroy(&server.map_lock); }