vinyl-cache/bin/vinyltest/vtest2/src/vtc_h2_hpack.c
0
/*-
1
 * Copyright (c) 2008-2016 Varnish Software AS
2
 * All rights reserved.
3
 *
4
 * Author: Guillaume Quintard <guillaume.quintard@gmail.com>
5
 *
6
 * SPDX-License-Identifier: BSD-2-Clause
7
 *
8
 * Redistribution and use in source and binary forms, with or without
9
 * modification, are permitted provided that the following conditions
10
 * are met:
11
 * 1. Redistributions of source code must retain the above copyright
12
 *    notice, this list of conditions and the following disclaimer.
13
 * 2. Redistributions in binary form must reproduce the above copyright
14
 *    notice, this list of conditions and the following disclaimer in the
15
 *    documentation and/or other materials provided with the distribution.
16
 *
17
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20
 * ARE DISCLAIMED.  IN NO EVENT SHALL AUTHOR OR CONTRIBUTORS BE LIABLE
21
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27
 * SUCH DAMAGE.
28
 */
29
30
#include <stdint.h>
31
#include <stdio.h>
32
#include <stdlib.h>
33
#include <string.h>
34
35
36
#include "vdef.h"
37
38
#include "vas.h"
39
#include "vqueue.h"
40
41
#include "hpack.h"
42
#include "vtc_h2_priv.h"
43
44
struct symbol {
45
        uint32_t        val;
46
        uint8_t         size;
47
};
48
49
static const struct symbol coding_table[] = {
50
#define HPACK(i, v, l) {v, l},
51
#include "vtc_h2_enctbl.h"
52
#undef HPACK
53
        {0, 0}
54
};
55
56
#include "vtc_h2_dectbl.h"
57
58
#define MASK(pack, n) (pack >> (64 - n))
59
static int
60 231
huff_decode(char *str, int nm, struct hpk_iter *iter, int ilen)
61
{
62 231
        int l = 0;
63 231
        uint64_t pack = 0;
64 231
        unsigned pl = 0; /* pack length*/
65 231
        struct stbl *tbl = &tbl_0;
66
        struct ssym *sym;
67
68 231
        (void)nm;
69 2667
        while (ilen > 0 || pl != 0) {
70
                /* make sure we have enough data*/
71 2667
                if (pl < tbl->msk) {
72 567
                        if (ilen == 0) {
73 231
                                if (pl == 0 || (MASK(pack, pl) ==
74 231
                                                (unsigned)((1U << pl) - 1U))) {
75 231
                                        assert(tbl == &tbl_0);
76 231
                                        return (l);
77
                                }
78 0
                        }
79
                        /* fit as many bytes as we can in pack */
80 2247
                        while (pl <= 56 && ilen > 0) {
81 3822
                                pack |= (uint64_t)(*iter->buf & 0xff)
82 1911
                                        << (56 - pl);
83 1911
                                pl += 8;
84 1911
                                iter->buf++;
85 1911
                                ilen--;
86
                        }
87 336
                }
88 2436
                assert(tbl);
89 2436
                assert(tbl->msk);
90 2436
                sym = &tbl->syms[MASK(pack, tbl->msk)];
91
92 2436
                assert(sym->csm <= tbl->msk);
93
94 2436
                if (sym->csm == 0 || pl < sym->csm)
95 0
                        return (0);
96
97 2436
                assert(sym->csm <= 8);
98 2436
                pack <<= sym->csm;
99 2436
                assert(sym->csm <= pl);
100 2436
                pl -= sym->csm;
101 2436
                if (sym->nxt) {
102 0
                        tbl = sym->nxt;
103 0
                        continue;
104
                }
105 2436
                str[l++] = sym->chr;
106 2436
                tbl = &tbl_0;
107
        }
108 0
        return (l);
109 231
}
110
111
/* inspired from Dridi Boukelmoune's cashpack. */
112
static enum hpk_result
113 294
huff_encode(struct hpk_iter *iter, const char *str, int len)
114
{
115 294
        uint64_t pack = 0;
116 294
        int pl = 0; /* pack length*/
117
        uint32_t        v;
118
        uint8_t         s;
119
120 294
        assert(iter->buf < iter->end);
121
122 3318
        while (len--) {
123 3024
                v = coding_table[(uint8_t)*str].val;
124 3024
                s = coding_table[(uint8_t)*str].size;
125
126 3024
                pl += s;
127 3024
                pack |= (uint64_t)v << (64 - pl);
128
129 5124
                while (pl >= 8) {
130 2100
                        if (iter->buf == iter->end)
131 0
                                return (hpk_done);
132 2100
                        *iter->buf = (char)(pack >> 56);
133 2100
                        iter->buf++;
134 2100
                        pack <<= 8;
135 2100
                        pl -= 8;
136
                }
137 3024
                str++;
138
        }
139
140
        /* padding */
141 294
        if (pl) {
142 294
                assert(pl < 8);
143 294
                if (iter->buf == iter->end)
144 0
                        return (hpk_done);
145 294
                pl += 8;
146 294
                pack |= (uint64_t)0xff << (64 - pl);
147 294
                *iter->buf = (char)(pack >> 56);
148 294
                iter->buf++;
149 294
        }
150
151 294
        return (hpk_more);
152 294
}
153
154
static int
155 81522
huff_simulate(const char *str, int ilen, int huff)
156
{
157 81522
        int olen = 0;
158 81522
        if (!huff || !ilen)
159 81228
                return (ilen);
160 3318
        while (ilen--) {
161 3024
                olen += coding_table[(unsigned char)*str].size;
162 3024
                str++;
163
        }
164 294
        return ((olen + 7) / 8);
165 81522
}
166
167
static enum hpk_result
168 54516
num_decode(uint32_t *result, struct hpk_iter *iter, uint8_t prefix)
169
{
170 54516
        uint8_t shift = 0;
171
172 54516
        assert(iter->buf < iter->end);
173 54516
        assert(prefix);
174 54516
        assert(prefix <= 8);
175
176 54516
        *result = 0;
177 54516
        *result = *iter->buf & (0xff >> (8-prefix));
178 54516
        if (*result < (1U << prefix) - 1U) {
179 42252
                iter->buf++;
180 42252
                return (ITER_DONE(iter));
181
        }
182 12264
        do {
183 12348
                iter->buf++;
184 12348
                if (iter->end == iter->buf)
185 0
                        return (hpk_err);
186
                /* check for overflow */
187 12348
                if ((UINT32_MAX - *result) >> shift < (*iter->buf & 0x7f))
188 0
                        return (hpk_err);
189
190 12348
                *result += (uint32_t)(*iter->buf & 0x7f) << shift;
191 12348
                shift += 7;
192 12348
        } while (*iter->buf & 0x80);
193 12264
        iter->buf++;
194
195 12264
        return (ITER_DONE(iter));
196 54516
}
197
198
static enum hpk_result
199 82740
num_encode(struct hpk_iter *iter, uint8_t prefix, uint32_t num)
200
{
201 82740
        assert(prefix);
202 82740
        assert(prefix <= 8);
203 82740
        assert(iter->buf < iter->end);
204
205 82740
        uint8_t pmax = (1U << prefix) - 1U;
206
207 82740
        *iter->buf &= 0xffU << prefix;
208 82740
        if (num <= pmax) {
209 61719
                *iter->buf++ |= num;
210 61719
                return (ITER_DONE(iter));
211 21021
        } else if (iter->end - iter->buf < 2)
212 0
                return (hpk_err);
213
214 21021
        iter->buf[0] |= pmax;
215 21021
        num -= pmax;
216 21021
        do {
217 42021
                iter->buf++;
218 42021
                if (iter->end == iter->buf)
219 0
                        return (hpk_err);
220 42021
                *iter->buf = num % 128;
221 42021
                *iter->buf |= 0x80;
222 42021
                num /= 128;
223 42021
        } while (num);
224 21021
        *iter->buf++ &= 127;
225 21021
        return (ITER_DONE(iter));
226 82740
}
227
228
static enum hpk_result
229 81522
str_encode(struct hpk_iter *iter, const struct hpk_txt *t)
230
{
231 81522
        int slen = huff_simulate(t->ptr, t->len, t->huff);
232 81522
        assert(iter->buf < iter->end);
233 81522
        if (t->huff)
234 294
                *iter->buf = 0x80;
235
        else
236 81228
                *iter->buf = 0;
237
238 81522
        if (hpk_err == num_encode(iter, 7, slen))
239 0
                return (hpk_err);
240
241 81522
        if (slen > iter->end - iter->buf)
242 0
                return (hpk_err);
243
244 81522
        if (t->huff) {
245 294
                return (huff_encode(iter, t->ptr, t->len));
246
        } else {
247 81228
                memcpy(iter->buf, t->ptr, slen);
248 81228
                iter->buf += slen;
249 81228
                return (ITER_DONE(iter));
250
        }
251 81522
}
252
253
static enum hpk_result
254 30219
str_decode(struct hpk_iter *iter, struct hpk_txt *t)
255
{
256
        uint32_t num;
257
        int huff;
258
259 30219
        assert(iter->buf < iter->end);
260
261 30219
        huff = (*iter->buf & 0x80);
262 30219
        if (hpk_more != num_decode(&num, iter, 7))
263 0
                return (hpk_err);
264 30219
        assert(iter->buf < iter->end);
265 30219
        if (num > (unsigned)(iter->end - iter->buf))
266 0
                return (hpk_err);
267 30219
        if (huff) { /*Huffman encoding */
268 231
                t->ptr = malloc((num * 8L) / 5L + 1L);
269 231
                AN(t->ptr);
270 231
                num = huff_decode(t->ptr, (num * 8) / 5, iter, num);
271 231
                if (!num) {
272 0
                        free(t->ptr);
273 0
                        return (hpk_err);
274
                }
275 231
                t->huff = 1;
276
                /* XXX: do we care? */
277 231
                t->ptr = realloc(t->ptr, num + 1L);
278 231
                AN(t->ptr);
279 231
        } else { /* literal string */
280 29988
                t->huff = 0;
281 29988
                t->ptr = malloc(num + 1L);
282 29988
                AN(t->ptr);
283 29988
                memcpy(t->ptr, iter->buf, num);
284 29988
                iter->buf += num;
285
        }
286
287 30219
        t->ptr[num] = '\0';
288 30219
        t->len = num;
289
290 30219
        return (ITER_DONE(iter));
291 30219
}
292
293
static inline void
294 18291
txtcpy(struct hpk_txt *to, const struct hpk_txt *from)
295
{
296
        //AZ(to->ptr);
297 18291
        to->ptr = malloc(from->len + 1L);
298 18291
        AN(to->ptr);
299 18291
        memcpy(to->ptr, from->ptr, from->len + 1L);
300 18291
        to->len = from->len;
301 18291
}
302
303
int
304 27300
gethpk_iterLen(const struct hpk_iter *iter)
305
{
306 27300
        return (iter->buf - iter->orig);
307
}
308
309
enum hpk_result
310 24297
HPK_DecHdr(struct hpk_iter *iter, struct hpk_hdr *header)
311
{
312 24297
        int pref = 0;
313
        const struct hpk_txt *t;
314
        uint32_t num;
315 24297
        int must_index = 0;
316 24297
        assert(iter);
317 24297
        assert(iter->buf < iter->end);
318
        /* Indexed Header Field */
319 24297
        if (*iter->buf & 128) {
320 2856
                header->t = hpk_idx;
321 2856
                if (hpk_err == num_decode(&num, iter, 7))
322 0
                        return (hpk_err);
323
324 2856
                if (num) { /* indexed key and value*/
325 2856
                        t = tbl_get_key(iter->ctx, num);
326 2856
                        if (!t)
327 42
                                return (hpk_err);
328 2814
                        txtcpy(&header->key, t);
329
330 2814
                        t = tbl_get_value(iter->ctx, num);
331 2814
                        if (!t) {
332 0
                                free(header->key.ptr);
333 0
                                return (hpk_err);
334
                        }
335
336 2814
                        txtcpy(&header->value, t);
337
338 2814
                        if (iter->buf < iter->end)
339 2772
                                return (hpk_more);
340
                        else
341 42
                                return (hpk_done);
342
                } else
343 0
                        return (hpk_err);
344
345
        }
346
        /* Literal Header Field with Incremental Indexing */
347 21441
        else if (*iter->buf >> 6 == 1) {
348 378
                header->t = hpk_inc;
349 378
                pref = 6;
350 378
                must_index = 1;
351 378
        }
352
        /* Literal Header Field without Indexing */
353 21063
        else if (*iter->buf >> 4 == 0) {
354 4410
                header->t = hpk_not;
355 4410
                pref = 4;
356 4410
        }
357
        /* Literal Header Field never Indexed */
358 16653
        else if (*iter->buf >> 4 == 1) {
359 16653
                header->t = hpk_never;
360 16653
                pref = 4;
361 16653
        }
362
        /* Dynamic Table Size Update */
363
        /* XXX if under max allowed value */
364 0
        else if (*iter->buf >> 5 == 1) {
365 0
                if (hpk_done != num_decode(&num, iter, 5))
366 0
                        return (hpk_err);
367 0
                return (HPK_ResizeTbl(iter->ctx, num));
368
        } else {
369 0
                return (hpk_err);
370
        }
371
372 21441
        assert(pref);
373 21441
        if (hpk_more != num_decode(&num, iter, pref))
374 0
                return (hpk_err);
375
376 21441
        header->i = num;
377 21441
        if (num) { /* indexed key */
378 12663
                t = tbl_get_key(iter->ctx, num);
379 12663
                if (!t)
380 0
                        return (hpk_err);
381 12663
                txtcpy(&header->key, t);
382 12663
        } else {
383 8778
                if (hpk_more != str_decode(iter, &header->key)) {
384 0
                        free(header->key.ptr);
385 0
                        return (hpk_err);
386
                }
387
        }
388
389 21441
        if (hpk_err == str_decode(iter, &header->value)) {
390 0
                free(header->key.ptr);
391 0
                return (hpk_err);
392
        }
393
394 21441
        if (must_index)
395 378
                push_header(iter->ctx, header);
396 21441
        return (ITER_DONE(iter));
397 24297
}
398
399
enum hpk_result
400 41811
HPK_EncHdr(struct hpk_iter *iter, const struct hpk_hdr *h)
401
{
402
        int pref;
403 41811
        int must_index = 0;
404
        enum hpk_result ret;
405 41811
        switch (h->t) {
406
                case hpk_idx:
407 882
                        *iter->buf = 0x80;
408 882
                        assert(num_encode(iter, 7, h->i) != hpk_err);
409 882
                        return (ITER_DONE(iter));
410
                case hpk_inc:
411 462
                        *iter->buf = 0x40;
412 462
                        pref = 6;
413 462
                        must_index = 1;
414 462
                        break;
415
                case hpk_not:
416 40446
                        *iter->buf = 0x00;
417 40446
                        pref = 4;
418 40446
                        break;
419
                case hpk_never:
420 21
                        *iter->buf = 0x10;
421 21
                        pref = 4;
422 21
                        break;
423
                default:
424 0
                        INCOMPL();
425 0
        }
426 40929
        if (h->i) {
427 336
                if (hpk_more != num_encode(iter, pref, h->i))
428 0
                        return (hpk_err);
429 336
        } else {
430 40593
                iter->buf++;
431 40593
                if (hpk_more != str_encode(iter, &h->key))
432 0
                        return (hpk_err);
433
        }
434 40929
        ret = str_encode(iter, &h->value);
435 40929
        if (ret == hpk_err)
436 0
                return (hpk_err);
437 40929
        if (must_index)
438 462
                push_header(iter->ctx, h);
439 40929
        return (ret);
440
441 41811
}