1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25#include <common.h>
26#include <command.h>
27#include <net.h>
28#include <asm/unaligned.h>
29
30#include "dns.h"
31
32char *net_dns_resolve;
33char *net_dns_env_var;
34
35static int dns_our_port;
36
37static void dns_send(void)
38{
39 struct header *header;
40 int n, name_len;
41 uchar *p, *pkt;
42 const char *s;
43 const char *name;
44 enum dns_query_type qtype = DNS_A_RECORD;
45
46 name = net_dns_resolve;
47 pkt = (uchar *)(net_tx_packet + net_eth_hdr_size() + IP_UDP_HDR_SIZE);
48 p = pkt;
49
50
51 header = (struct header *)pkt;
52 header->tid = 1;
53 header->flags = htons(0x100);
54 header->nqueries = htons(1);
55 header->nanswers = 0;
56 header->nauth = 0;
57 header->nother = 0;
58
59
60 name_len = strlen(name);
61 p = (uchar *)&header->data;
62
63 do {
64 s = strchr(name, '.');
65 if (!s)
66 s = name + name_len;
67
68 n = s - name;
69 *p++ = n;
70 memcpy(p, name, n);
71 p += n;
72
73 if (*s == '.')
74 n++;
75
76 name += n;
77 name_len -= n;
78 } while (*s != '\0');
79
80 *p++ = 0;
81 *p++ = 0;
82 *p++ = (unsigned char) qtype;
83
84 *p++ = 0;
85 *p++ = 1;
86
87 n = p - pkt;
88 debug("Packet size %d\n", n);
89
90 dns_our_port = random_port();
91
92 net_send_udp_packet(net_server_ethaddr, net_dns_server,
93 DNS_SERVICE_PORT, dns_our_port, n);
94 debug("DNS packet sent\n");
95}
96
97static void dns_timeout_handler(void)
98{
99 puts("Timeout\n");
100 net_set_state(NETLOOP_FAIL);
101}
102
103static void dns_handler(uchar *pkt, unsigned dest, struct in_addr sip,
104 unsigned src, unsigned len)
105{
106 struct header *header;
107 const unsigned char *p, *e, *s;
108 u16 type, i;
109 int found, stop, dlen;
110 char ip_str[22];
111 struct in_addr ip_addr;
112
113
114 debug("%s\n", __func__);
115 if (dest != dns_our_port)
116 return;
117
118 for (i = 0; i < len; i += 4)
119 debug("0x%p - 0x%.2x 0x%.2x 0x%.2x 0x%.2x\n",
120 pkt+i, pkt[i], pkt[i+1], pkt[i+2], pkt[i+3]);
121
122
123 header = (struct header *)pkt;
124 if (ntohs(header->nqueries) != 1)
125 return;
126
127
128 if (header->nanswers == 0) {
129 puts("DNS: host not found\n");
130 net_set_state(NETLOOP_SUCCESS);
131 return;
132 }
133
134
135 s = &header->data[0];
136 e = pkt + len;
137 for (p = s; p < e && *p != '\0'; p++)
138 continue;
139
140
141 if (&p[5] > e || get_unaligned_be16(p+1) != DNS_A_RECORD) {
142 puts("DNS: response was not an A record\n");
143 net_set_state(NETLOOP_SUCCESS);
144 return;
145 }
146
147
148 p += 5;
149
150
151 for (found = stop = 0; !stop && &p[12] < e; ) {
152
153 if (*p != 0xc0) {
154 while (*p && &p[12] < e)
155 p++;
156 p--;
157 }
158 debug("Name (Offset in header): %d\n", p[1]);
159
160 type = get_unaligned_be16(p+2);
161 debug("type = %d\n", type);
162 if (type == DNS_CNAME_RECORD) {
163
164 debug("Found canonical name\n");
165 dlen = get_unaligned_be16(p+10);
166 debug("dlen = %d\n", dlen);
167 p += 12 + dlen;
168 } else if (type == DNS_A_RECORD) {
169 debug("Found A-record\n");
170 found = 1;
171 stop = 1;
172 } else {
173 debug("Unknown type\n");
174 stop = 1;
175 }
176 }
177
178 if (found && &p[12] < e) {
179 dlen = get_unaligned_be16(p+10);
180 p += 12;
181 memcpy(&ip_addr, p, 4);
182
183 if (p + dlen <= e) {
184 ip_to_string(ip_addr, ip_str);
185 printf("%s\n", ip_str);
186 if (net_dns_env_var)
187 setenv(net_dns_env_var, ip_str);
188 } else {
189 puts("server responded with invalid IP number\n");
190 }
191 }
192
193 net_set_state(NETLOOP_SUCCESS);
194}
195
196void dns_start(void)
197{
198 debug("%s\n", __func__);
199
200 net_set_timeout_handler(DNS_TIMEOUT, dns_timeout_handler);
201 net_set_udp_handler(dns_handler);
202
203
204 memset(net_server_ethaddr, 0, sizeof(net_server_ethaddr));
205
206 dns_send();
207}
208