1
2
3
4
5
6
7
8
9
10#if ENABLE_FEATURE_UDHCP_RFC3397
11
12#include "common.h"
13#include "options.h"
14
15#define NS_MAXDNAME 1025
16#define NS_MAXCDNAME 255
17#define NS_MAXLABEL 63
18#define NS_MAXDNSRCH 6
19#define NS_CMPRSFLGS 0xc0
20
21
22
23
24
25
26char* FAST_FUNC dname_dec(const uint8_t *cstr, int clen, const char *pre)
27{
28 const uint8_t *c;
29 int crtpos, retpos, depth, plen = 0, len = 0;
30 char *dst = NULL;
31
32 if (!cstr)
33 return NULL;
34
35 if (pre)
36 plen = strlen(pre);
37
38
39
40
41
42
43
44
45
46 while (!dst) {
47
48 if (len > 0) {
49 dst = xmalloc(len + plen);
50 memcpy(dst, pre, plen);
51 }
52
53 crtpos = retpos = depth = len = 0;
54
55 while (crtpos < clen) {
56 c = cstr + crtpos;
57
58 if ((*c & NS_CMPRSFLGS) != 0) {
59 if (crtpos + 2 > clen)
60 return NULL;
61 if (retpos == 0)
62 retpos = crtpos + 2;
63 depth++;
64 crtpos = ((*c & 0x3f) << 8) | (*(c + 1) & 0xff);
65 } else if (*c) {
66 if (crtpos + *c + 1 > clen)
67 return NULL;
68 if (dst)
69 memcpy(dst + plen + len, c + 1, *c);
70 len += *c + 1;
71 crtpos += *c + 1;
72 if (dst)
73 *(dst + plen + len - 1) = '.';
74 } else {
75 if (retpos == 0) {
76 crtpos++;
77 } else {
78 crtpos = retpos;
79 retpos = depth = 0;
80 }
81 if (dst)
82 *(dst + plen + len - 1) = ' ';
83 }
84
85 if (depth > NS_MAXDNSRCH ||
86 len > NS_MAXDNAME * NS_MAXDNSRCH)
87 return NULL;
88 }
89
90 if (!len)
91 return NULL;
92
93 if (dst)
94 *(dst + plen + len - 1) = '\0';
95 }
96
97 return dst;
98}
99
100
101
102
103
104static uint8_t *convert_dname(const char *src)
105{
106 uint8_t c, *res, *lp, *rp;
107 int len;
108
109 res = xmalloc(strlen(src) + 2);
110 rp = lp = res;
111 rp++;
112
113 for (;;) {
114 c = (uint8_t)*src++;
115 if (c == '.' || c == '\0') {
116 len = rp - lp - 1;
117
118 if (len > NS_MAXLABEL || len == 0 || (c == '.' && *src == '.')) {
119 free(res);
120 return NULL;
121 }
122 *lp = len;
123 lp = rp++;
124 if (c == '\0' || *src == '\0')
125 break;
126 } else {
127 if (c >= 0x41 && c <= 0x5A)
128 c += 0x20;
129 *rp++ = c;
130 }
131 }
132
133 *lp = 0;
134 if (rp - res > NS_MAXCDNAME) {
135 free(res);
136 return NULL;
137 }
138 return res;
139}
140
141
142
143static int find_offset(const uint8_t *cstr, int clen, const uint8_t *dname)
144{
145 const uint8_t *c, *d;
146 int off, inc;
147
148
149 off = 0;
150 while (off < clen) {
151 c = cstr + off;
152
153 if ((*c & NS_CMPRSFLGS) != 0) {
154 off += 2;
155 } else if (*c) {
156 inc = *c + 1;
157 d = dname;
158 while (*c == *d && memcmp(c + 1, d + 1, *c) == 0) {
159 if (*c == 0)
160 return off;
161 d += *c + 1;
162 c += *c + 1;
163 if ((*c & NS_CMPRSFLGS) != 0)
164 c = cstr + (((*c & 0x3f) << 8) | (*(c + 1) & 0xff));
165 }
166 off += inc;
167 } else {
168 off++;
169 }
170 }
171
172 return -1;
173}
174
175
176
177
178
179
180
181uint8_t* FAST_FUNC dname_enc(const uint8_t *cstr, int clen, const char *src, int *retlen)
182{
183 uint8_t *d, *dname;
184 int off;
185
186 dname = convert_dname(src);
187 if (dname == NULL) {
188 *retlen = 0;
189 return NULL;
190 }
191
192 for (d = dname; *d != 0; d += *d + 1) {
193 off = find_offset(cstr, clen, d);
194 if (off >= 0) {
195 *d++ = NS_CMPRSFLGS;
196 *d = off;
197 break;
198 }
199 }
200
201 *retlen = d - dname + 1;
202 return dname;
203}
204
205#endif
206