rockchip: rk3399: Add Nanopi M4 2GB board support
[platform/kernel/u-boot.git] / net / dns.c
1 /*
2  * DNS support driver
3  *
4  * Copyright (c) 2008 Pieter Voorthuijsen <pieter.voorthuijsen@prodrive.nl>
5  * Copyright (c) 2009 Robin Getz <rgetz@blackfin.uclinux.org>
6  *
7  * This is a simple DNS implementation for U-Boot. It will use the first IP
8  * in the DNS response as net_server_ip. This can then be used for any other
9  * network related activities.
10  *
11  * The packet handling is partly based on TADNS, original copyrights
12  * follow below.
13  *
14  */
15
16 /*
17  * Copyright (c) 2004-2005 Sergey Lyubka <valenok@gmail.com>
18  *
19  * "THE BEER-WARE LICENSE" (Revision 42):
20  * Sergey Lyubka wrote this file.  As long as you retain this notice you
21  * can do whatever you want with this stuff. If we meet some day, and you think
22  * this stuff is worth it, you can buy me a beer in return.
23  */
24
25 #include <common.h>
26 #include <command.h>
27 #include <env.h>
28 #include <net.h>
29 #include <asm/unaligned.h>
30
31 #include "dns.h"
32
33 char *net_dns_resolve;  /* The host to resolve  */
34 char *net_dns_env_var;  /* The envvar to store the answer in */
35
36 static int dns_our_port;
37
38 static void dns_send(void)
39 {
40         struct header *header;
41         int n, name_len;
42         uchar *p, *pkt;
43         const char *s;
44         const char *name;
45         enum dns_query_type qtype = DNS_A_RECORD;
46
47         name = net_dns_resolve;
48         pkt = (uchar *)(net_tx_packet + net_eth_hdr_size() + IP_UDP_HDR_SIZE);
49         p = pkt;
50
51         /* Prepare DNS packet header */
52         header           = (struct header *)pkt;
53         header->tid      = 1;
54         header->flags    = htons(0x100);        /* standard query */
55         header->nqueries = htons(1);            /* Just one query */
56         header->nanswers = 0;
57         header->nauth    = 0;
58         header->nother   = 0;
59
60         /* Encode DNS name */
61         name_len = strlen(name);
62         p = (uchar *)&header->data;     /* For encoding host name into packet */
63
64         do {
65                 s = strchr(name, '.');
66                 if (!s)
67                         s = name + name_len;
68
69                 n = s - name;                   /* Chunk length */
70                 *p++ = n;                       /* Copy length  */
71                 memcpy(p, name, n);             /* Copy chunk   */
72                 p += n;
73
74                 if (*s == '.')
75                         n++;
76
77                 name += n;
78                 name_len -= n;
79         } while (*s != '\0');
80
81         *p++ = 0;                       /* Mark end of host name */
82         *p++ = 0;                       /* Some servers require double null */
83         *p++ = (unsigned char) qtype;   /* Query Type */
84
85         *p++ = 0;
86         *p++ = 1;                               /* Class: inet, 0x0001 */
87
88         n = p - pkt;                            /* Total packet length */
89         debug("Packet size %d\n", n);
90
91         dns_our_port = random_port();
92
93         net_send_udp_packet(net_server_ethaddr, net_dns_server,
94                             DNS_SERVICE_PORT, dns_our_port, n);
95         debug("DNS packet sent\n");
96 }
97
98 static void dns_timeout_handler(void)
99 {
100         puts("Timeout\n");
101         net_set_state(NETLOOP_FAIL);
102 }
103
104 static void dns_handler(uchar *pkt, unsigned dest, struct in_addr sip,
105                         unsigned src, unsigned len)
106 {
107         struct header *header;
108         const unsigned char *p, *e, *s;
109         u16 type, i;
110         int found, stop, dlen;
111         char ip_str[22];
112         struct in_addr ip_addr;
113
114
115         debug("%s\n", __func__);
116         if (dest != dns_our_port)
117                 return;
118
119         for (i = 0; i < len; i += 4)
120                 debug("0x%p - 0x%.2x  0x%.2x  0x%.2x  0x%.2x\n",
121                       pkt+i, pkt[i], pkt[i+1], pkt[i+2], pkt[i+3]);
122
123         /* We sent one query. We want to have a single answer: */
124         header = (struct header *)pkt;
125         if (ntohs(header->nqueries) != 1)
126                 return;
127
128         /* Received 0 answers */
129         if (header->nanswers == 0) {
130                 puts("DNS: host not found\n");
131                 net_set_state(NETLOOP_SUCCESS);
132                 return;
133         }
134
135         /* Skip host name */
136         s = &header->data[0];
137         e = pkt + len;
138         for (p = s; p < e && *p != '\0'; p++)
139                 continue;
140
141         /* We sent query class 1, query type 1 */
142         if (&p[5] > e || get_unaligned_be16(p+1) != DNS_A_RECORD) {
143                 puts("DNS: response was not an A record\n");
144                 net_set_state(NETLOOP_SUCCESS);
145                 return;
146         }
147
148         /* Go to the first answer section */
149         p += 5;
150
151         /* Loop through the answers, we want A type answer */
152         for (found = stop = 0; !stop && &p[12] < e; ) {
153                 /* Skip possible name in CNAME answer */
154                 if (*p != 0xc0) {
155                         while (*p && &p[12] < e)
156                                 p++;
157                         p--;
158                 }
159                 debug("Name (Offset in header): %d\n", p[1]);
160
161                 type = get_unaligned_be16(p+2);
162                 debug("type = %d\n", type);
163                 if (type == DNS_CNAME_RECORD) {
164                         /* CNAME answer. shift to the next section */
165                         debug("Found canonical name\n");
166                         dlen = get_unaligned_be16(p+10);
167                         debug("dlen = %d\n", dlen);
168                         p += 12 + dlen;
169                 } else if (type == DNS_A_RECORD) {
170                         debug("Found A-record\n");
171                         found = 1;
172                         stop = 1;
173                 } else {
174                         debug("Unknown type\n");
175                         stop = 1;
176                 }
177         }
178
179         if (found && &p[12] < e) {
180                 dlen = get_unaligned_be16(p+10);
181                 p += 12;
182                 memcpy(&ip_addr, p, 4);
183
184                 if (p + dlen <= e) {
185                         ip_to_string(ip_addr, ip_str);
186                         printf("%s\n", ip_str);
187                         if (net_dns_env_var)
188                                 env_set(net_dns_env_var, ip_str);
189                 } else {
190                         puts("server responded with invalid IP number\n");
191                 }
192         }
193
194         net_set_state(NETLOOP_SUCCESS);
195 }
196
197 void dns_start(void)
198 {
199         debug("%s\n", __func__);
200
201         net_set_timeout_handler(DNS_TIMEOUT, dns_timeout_handler);
202         net_set_udp_handler(dns_handler);
203
204         /* Clear a previous MAC address, the server IP might have changed. */
205         memset(net_server_ethaddr, 0, sizeof(net_server_ethaddr));
206
207         dns_send();
208 }