blob: fbcb6a4207b7e625279c61029f3d9ff073785618 [file] [log] [blame]
Austin Schuh812d0d12021-11-04 20:16:48 -07001/**
2 * The MIT License (MIT)
3 *
4 * Copyright (c) 2015-2021 Nicholas Fraser and the MPack authors
5 *
6 * Permission is hereby granted, free of charge, to any person obtaining a copy
7 * of this software and associated documentation files (the "Software"), to deal
8 * in the Software without restriction, including without limitation the rights
9 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10 * copies of the Software, and to permit persons to whom the Software is
11 * furnished to do so, subject to the following conditions:
12 *
13 * The above copyright notice and this permission notice shall be included in all
14 * copies or substantial portions of the Software.
15 *
16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
19 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
22 * SOFTWARE.
23 *
24 */
25
26/*
27 * This is the MPack 1.1 amalgamation package.
28 *
29 * http://github.com/ludocode/mpack
30 */
31
32#define MPACK_INTERNAL 1
33#define MPACK_EMIT_INLINE_DEFS 0
34
35#include "wpi/mpack.h"
36
37
38/* mpack/mpack-platform.c.c */
39
40
41// We define MPACK_EMIT_INLINE_DEFS and include mpack.h to emit
42// standalone definitions of all (non-static) inline functions in MPack.
43
44#define MPACK_INTERNAL 1
45#define MPACK_EMIT_INLINE_DEFS 0
46
47/* #include "mpack-platform.h" */
48/* #include "mpack.h" */
49
50MPACK_SILENCE_WARNINGS_BEGIN
51namespace mpack {
52
53#if MPACK_DEBUG
54
55#if MPACK_STDIO
56void mpack_assert_fail_format(const char* format, ...) {
57 char buffer[512];
58 va_list args;
59 va_start(args, format);
60 vsnprintf(buffer, sizeof(buffer), format, args);
61 va_end(args);
62 buffer[sizeof(buffer) - 1] = 0;
63 mpack_assert_fail_wrapper(buffer);
64}
65
66void mpack_break_hit_format(const char* format, ...) {
67 char buffer[512];
68 va_list args;
69 va_start(args, format);
70 vsnprintf(buffer, sizeof(buffer), format, args);
71 va_end(args);
72 buffer[sizeof(buffer) - 1] = 0;
73 mpack_break_hit(buffer);
74}
75#endif
76
77#if !MPACK_CUSTOM_ASSERT
78void mpack_assert_fail(const char* message) {
79 MPACK_UNUSED(message);
80
81 #if MPACK_STDIO
82 fprintf(stderr, "%s\n", message);
83 #endif
84}
85#endif
86
87// We split the assert failure from the wrapper so that a
88// custom assert function can return.
89void mpack_assert_fail_wrapper(const char* message) {
90
91 #ifdef MPACK_GCOV
92 // gcov marks even __builtin_unreachable() as an uncovered line. this
93 // silences it.
94 (mpack_assert_fail(message), __builtin_unreachable());
95
96 #else
97 mpack_assert_fail(message);
98
99 // mpack_assert_fail() is not supposed to return. in case it does, we
100 // abort.
101
102 #if !MPACK_NO_BUILTINS
103 #if defined(__GNUC__) || defined(__clang__)
104 __builtin_trap();
105 #elif defined(WIN32)
106 __debugbreak();
107 #endif
108 #endif
109
110 #if (defined(__GNUC__) || defined(__clang__)) && !MPACK_NO_BUILTINS
111 __builtin_abort();
112 #elif MPACK_STDLIB
113 abort();
114 #endif
115
116 MPACK_UNREACHABLE;
117 #endif
118}
119
120#if !MPACK_CUSTOM_BREAK
121
122// If we have a custom assert handler, break wraps it by default.
123// This allows users of MPack to only implement mpack_assert_fail() without
124// having to worry about the difference between assert and break.
125//
126// MPACK_CUSTOM_BREAK is available to define a separate break handler
127// (which is needed by the unit test suite), but this is not offered in
128// mpack-config.h for simplicity.
129
130#if MPACK_CUSTOM_ASSERT
131void mpack_break_hit(const char* message) {
132 mpack_assert_fail_wrapper(message);
133}
134#else
135void mpack_break_hit(const char* message) {
136 MPACK_UNUSED(message);
137
138 #if MPACK_STDIO
139 fprintf(stderr, "%s\n", message);
140 #endif
141
142 #if defined(__GNUC__) || defined(__clang__) && !MPACK_NO_BUILTINS
143 __builtin_trap();
144 #elif defined(WIN32) && !MPACK_NO_BUILTINS
145 __debugbreak();
146 #elif MPACK_STDLIB
147 abort();
148 #endif
149}
150#endif
151
152#endif
153
154#endif
155
156
157
158// The below are adapted from the C wikibook:
159// https://en.wikibooks.org/wiki/C_Programming/Strings
160
161#ifndef mpack_memcmp
162int mpack_memcmp(const void* s1, const void* s2, size_t n) {
163 const unsigned char *us1 = (const unsigned char *) s1;
164 const unsigned char *us2 = (const unsigned char *) s2;
165 while (n-- != 0) {
166 if (*us1 != *us2)
167 return (*us1 < *us2) ? -1 : +1;
168 us1++;
169 us2++;
170 }
171 return 0;
172}
173#endif
174
175#ifndef mpack_memcpy
176void* mpack_memcpy(void* MPACK_RESTRICT s1, const void* MPACK_RESTRICT s2, size_t n) {
177 char* MPACK_RESTRICT dst = (char *)s1;
178 const char* MPACK_RESTRICT src = (const char *)s2;
179 while (n-- != 0)
180 *dst++ = *src++;
181 return s1;
182}
183#endif
184
185#ifndef mpack_memmove
186void* mpack_memmove(void* s1, const void* s2, size_t n) {
187 char *p1 = (char *)s1;
188 const char *p2 = (const char *)s2;
189 if (p2 < p1 && p1 < p2 + n) {
190 p2 += n;
191 p1 += n;
192 while (n-- != 0)
193 *--p1 = *--p2;
194 } else
195 while (n-- != 0)
196 *p1++ = *p2++;
197 return s1;
198}
199#endif
200
201#ifndef mpack_memset
202void* mpack_memset(void* s, int c, size_t n) {
203 unsigned char *us = (unsigned char *)s;
204 unsigned char uc = (unsigned char)c;
205 while (n-- != 0)
206 *us++ = uc;
207 return s;
208}
209#endif
210
211#ifndef mpack_strlen
212size_t mpack_strlen(const char* s) {
213 const char* p = s;
214 while (*p != '\0')
215 p++;
216 return (size_t)(p - s);
217}
218#endif
219
220
221
222#if defined(MPACK_MALLOC) && !defined(MPACK_REALLOC)
223void* mpack_realloc(void* old_ptr, size_t used_size, size_t new_size) {
224 if (new_size == 0) {
225 if (old_ptr)
226 MPACK_FREE(old_ptr);
227 return NULL;
228 }
229
230 void* new_ptr = MPACK_MALLOC(new_size);
231 if (new_ptr == NULL)
232 return NULL;
233
234 mpack_memcpy(new_ptr, old_ptr, used_size);
235 MPACK_FREE(old_ptr);
236 return new_ptr;
237}
238#endif
239
240MPACK_SILENCE_WARNINGS_END
241
242/* mpack/mpack-common.c.c */
243
244#define MPACK_INTERNAL 1
245
246/* #include "mpack-common.h" */
247
248MPACK_SILENCE_WARNINGS_BEGIN
249
250const char* mpack_error_to_string(mpack_error_t error) {
251 #if MPACK_STRINGS
252 switch (error) {
253 #define MPACK_ERROR_STRING_CASE(e) case e: return #e
254 MPACK_ERROR_STRING_CASE(mpack_ok);
255 MPACK_ERROR_STRING_CASE(mpack_error_io);
256 MPACK_ERROR_STRING_CASE(mpack_error_invalid);
257 MPACK_ERROR_STRING_CASE(mpack_error_unsupported);
258 MPACK_ERROR_STRING_CASE(mpack_error_type);
259 MPACK_ERROR_STRING_CASE(mpack_error_too_big);
260 MPACK_ERROR_STRING_CASE(mpack_error_memory);
261 MPACK_ERROR_STRING_CASE(mpack_error_bug);
262 MPACK_ERROR_STRING_CASE(mpack_error_data);
263 MPACK_ERROR_STRING_CASE(mpack_error_eof);
264 #undef MPACK_ERROR_STRING_CASE
265 }
266 mpack_assert(0, "unrecognized error %i", (int)error);
267 return "(unknown mpack_error_t)";
268 #else
269 MPACK_UNUSED(error);
270 return "";
271 #endif
272}
273
274const char* mpack_type_to_string(mpack_type_t type) {
275 #if MPACK_STRINGS
276 switch (type) {
277 #define MPACK_TYPE_STRING_CASE(e) case e: return #e
278 MPACK_TYPE_STRING_CASE(mpack_type_missing);
279 MPACK_TYPE_STRING_CASE(mpack_type_nil);
280 MPACK_TYPE_STRING_CASE(mpack_type_bool);
281 MPACK_TYPE_STRING_CASE(mpack_type_float);
282 MPACK_TYPE_STRING_CASE(mpack_type_double);
283 MPACK_TYPE_STRING_CASE(mpack_type_int);
284 MPACK_TYPE_STRING_CASE(mpack_type_uint);
285 MPACK_TYPE_STRING_CASE(mpack_type_str);
286 MPACK_TYPE_STRING_CASE(mpack_type_bin);
287 MPACK_TYPE_STRING_CASE(mpack_type_array);
288 MPACK_TYPE_STRING_CASE(mpack_type_map);
289 #if MPACK_EXTENSIONS
290 MPACK_TYPE_STRING_CASE(mpack_type_ext);
291 #endif
292 #undef MPACK_TYPE_STRING_CASE
293 }
294 mpack_assert(0, "unrecognized type %i", (int)type);
295 return "(unknown mpack_type_t)";
296 #else
297 MPACK_UNUSED(type);
298 return "";
299 #endif
300}
301
302int mpack_tag_cmp(mpack_tag_t left, mpack_tag_t right) {
303
304 // positive numbers may be stored as int; convert to uint
305 if (left.type == mpack_type_int && left.v.i >= 0) {
306 left.type = mpack_type_uint;
307 left.v.u = (uint64_t)left.v.i;
308 }
309 if (right.type == mpack_type_int && right.v.i >= 0) {
310 right.type = mpack_type_uint;
311 right.v.u = (uint64_t)right.v.i;
312 }
313
314 if (left.type != right.type)
315 return ((int)left.type < (int)right.type) ? -1 : 1;
316
317 switch (left.type) {
318 case mpack_type_missing: // fallthrough
319 case mpack_type_nil:
320 return 0;
321
322 case mpack_type_bool:
323 return (int)left.v.b - (int)right.v.b;
324
325 case mpack_type_int:
326 if (left.v.i == right.v.i)
327 return 0;
328 return (left.v.i < right.v.i) ? -1 : 1;
329
330 case mpack_type_uint:
331 if (left.v.u == right.v.u)
332 return 0;
333 return (left.v.u < right.v.u) ? -1 : 1;
334
335 case mpack_type_array:
336 case mpack_type_map:
337 if (left.v.n == right.v.n)
338 return 0;
339 return (left.v.n < right.v.n) ? -1 : 1;
340
341 case mpack_type_str:
342 case mpack_type_bin:
343 if (left.v.l == right.v.l)
344 return 0;
345 return (left.v.l < right.v.l) ? -1 : 1;
346
347 #if MPACK_EXTENSIONS
348 case mpack_type_ext:
349 if (left.exttype == right.exttype) {
350 if (left.v.l == right.v.l)
351 return 0;
352 return (left.v.l < right.v.l) ? -1 : 1;
353 }
354 return (int)left.exttype - (int)right.exttype;
355 #endif
356
357 // floats should not normally be compared for equality. we compare
358 // with memcmp() to silence compiler warnings, but this will return
359 // equal if both are NaNs with the same representation (though we may
360 // want this, for instance if you are for some bizarre reason using
361 // floats as map keys.) i'm not sure what the right thing to
362 // do is here. check for NaN first? always return false if the type
363 // is float? use operator== and pragmas to silence compiler warning?
364 // please send me your suggestions.
365 // note also that we don't convert floats to doubles, so when this is
366 // used for ordering purposes, all floats are ordered before all
367 // doubles.
368 case mpack_type_float:
369 return mpack_memcmp(&left.v.f, &right.v.f, sizeof(left.v.f));
370 case mpack_type_double:
371 return mpack_memcmp(&left.v.d, &right.v.d, sizeof(left.v.d));
372 }
373
374 mpack_assert(0, "unrecognized type %i", (int)left.type);
375 return false;
376}
377
378#if MPACK_DEBUG && MPACK_STDIO
379static char mpack_hex_char(uint8_t hex_value) {
380 // Older compilers (e.g. GCC 4.4.7) promote the result of this ternary to
381 // int and warn under -Wconversion, so we have to cast it back to char.
382 return (char)((hex_value < 10) ? (char)('0' + hex_value) : (char)('a' + (hex_value - 10)));
383}
384
385static void mpack_tag_debug_complete_bin_ext(mpack_tag_t tag, size_t string_length, char* buffer, size_t buffer_size,
386 const char* prefix, size_t prefix_size)
387{
388 // If at any point in this function we run out of space in the buffer, we
389 // bail out. The outer tag print wrapper will make sure we have a
390 // null-terminator.
391
392 if (string_length == 0 || string_length >= buffer_size)
393 return;
394 buffer += string_length;
395 buffer_size -= string_length;
396
397 size_t total = mpack_tag_bytes(&tag);
398 if (total == 0) {
399 strncpy(buffer, ">", buffer_size);
400 return;
401 }
402
403 strncpy(buffer, ": ", buffer_size);
404 if (buffer_size < 2)
405 return;
406 buffer += 2;
407 buffer_size -= 2;
408
409 size_t hex_bytes = 0;
410 size_t i;
411 for (i = 0; i < MPACK_PRINT_BYTE_COUNT && i < prefix_size && buffer_size > 2; ++i) {
412 uint8_t byte = (uint8_t)prefix[i];
413 buffer[0] = mpack_hex_char((uint8_t)(byte >> 4));
414 buffer[1] = mpack_hex_char((uint8_t)(byte & 0xfu));
415 buffer += 2;
416 buffer_size -= 2;
417 ++hex_bytes;
418 }
419
420 if (buffer_size != 0)
421 mpack_snprintf(buffer, buffer_size, "%s>", (total > hex_bytes) ? "..." : "");
422}
423
424static void mpack_tag_debug_pseudo_json_bin(mpack_tag_t tag, char* buffer, size_t buffer_size,
425 const char* prefix, size_t prefix_size)
426{
427 mpack_assert(mpack_tag_type(&tag) == mpack_type_bin);
428 size_t length = (size_t)mpack_snprintf(buffer, buffer_size, "<binary data of length %u", tag.v.l);
429 mpack_tag_debug_complete_bin_ext(tag, length, buffer, buffer_size, prefix, prefix_size);
430}
431
432#if MPACK_EXTENSIONS
433static void mpack_tag_debug_pseudo_json_ext(mpack_tag_t tag, char* buffer, size_t buffer_size,
434 const char* prefix, size_t prefix_size)
435{
436 mpack_assert(mpack_tag_type(&tag) == mpack_type_ext);
437 size_t length = (size_t)mpack_snprintf(buffer, buffer_size, "<ext data of type %i and length %u",
438 mpack_tag_ext_exttype(&tag), mpack_tag_ext_length(&tag));
439 mpack_tag_debug_complete_bin_ext(tag, length, buffer, buffer_size, prefix, prefix_size);
440}
441#endif
442
443static void mpack_tag_debug_pseudo_json_impl(mpack_tag_t tag, char* buffer, size_t buffer_size,
444 const char* prefix, size_t prefix_size)
445{
446 switch (tag.type) {
447 case mpack_type_missing:
448 mpack_snprintf(buffer, buffer_size, "<missing!>");
449 return;
450 case mpack_type_nil:
451 mpack_snprintf(buffer, buffer_size, "null");
452 return;
453 case mpack_type_bool:
454 mpack_snprintf(buffer, buffer_size, tag.v.b ? "true" : "false");
455 return;
456 case mpack_type_int:
457 mpack_snprintf(buffer, buffer_size, "%" PRIi64, tag.v.i);
458 return;
459 case mpack_type_uint:
460 mpack_snprintf(buffer, buffer_size, "%" PRIu64, tag.v.u);
461 return;
462 case mpack_type_float:
463 #if MPACK_FLOAT
464 mpack_snprintf(buffer, buffer_size, "%f", tag.v.f);
465 #else
466 mpack_snprintf(buffer, buffer_size, "<float>");
467 #endif
468 return;
469 case mpack_type_double:
470 #if MPACK_DOUBLE
471 mpack_snprintf(buffer, buffer_size, "%f", tag.v.d);
472 #else
473 mpack_snprintf(buffer, buffer_size, "<double>");
474 #endif
475 return;
476
477 case mpack_type_str:
478 mpack_snprintf(buffer, buffer_size, "<string of %u bytes>", tag.v.l);
479 return;
480 case mpack_type_bin:
481 mpack_tag_debug_pseudo_json_bin(tag, buffer, buffer_size, prefix, prefix_size);
482 return;
483 #if MPACK_EXTENSIONS
484 case mpack_type_ext:
485 mpack_tag_debug_pseudo_json_ext(tag, buffer, buffer_size, prefix, prefix_size);
486 return;
487 #endif
488
489 case mpack_type_array:
490 mpack_snprintf(buffer, buffer_size, "<array of %u elements>", tag.v.n);
491 return;
492 case mpack_type_map:
493 mpack_snprintf(buffer, buffer_size, "<map of %u key-value pairs>", tag.v.n);
494 return;
495 }
496
497 mpack_snprintf(buffer, buffer_size, "<unknown!>");
498}
499
500void mpack_tag_debug_pseudo_json(mpack_tag_t tag, char* buffer, size_t buffer_size,
501 const char* prefix, size_t prefix_size)
502{
503 mpack_assert(buffer_size > 0, "buffer size cannot be zero!");
504 buffer[0] = 0;
505
506 mpack_tag_debug_pseudo_json_impl(tag, buffer, buffer_size, prefix, prefix_size);
507
508 // We always null-terminate the buffer manually just in case the snprintf()
509 // function doesn't null-terminate when the string doesn't fit.
510 buffer[buffer_size - 1] = 0;
511}
512
513static void mpack_tag_debug_describe_impl(mpack_tag_t tag, char* buffer, size_t buffer_size) {
514 switch (tag.type) {
515 case mpack_type_missing:
516 mpack_snprintf(buffer, buffer_size, "missing");
517 return;
518 case mpack_type_nil:
519 mpack_snprintf(buffer, buffer_size, "nil");
520 return;
521 case mpack_type_bool:
522 mpack_snprintf(buffer, buffer_size, tag.v.b ? "true" : "false");
523 return;
524 case mpack_type_int:
525 mpack_snprintf(buffer, buffer_size, "int %" PRIi64, tag.v.i);
526 return;
527 case mpack_type_uint:
528 mpack_snprintf(buffer, buffer_size, "uint %" PRIu64, tag.v.u);
529 return;
530 case mpack_type_float:
531 #if MPACK_FLOAT
532 mpack_snprintf(buffer, buffer_size, "float %f", tag.v.f);
533 #else
534 mpack_snprintf(buffer, buffer_size, "float");
535 #endif
536 return;
537 case mpack_type_double:
538 #if MPACK_DOUBLE
539 mpack_snprintf(buffer, buffer_size, "double %f", tag.v.d);
540 #else
541 mpack_snprintf(buffer, buffer_size, "double");
542 #endif
543 return;
544 case mpack_type_str:
545 mpack_snprintf(buffer, buffer_size, "str of %u bytes", tag.v.l);
546 return;
547 case mpack_type_bin:
548 mpack_snprintf(buffer, buffer_size, "bin of %u bytes", tag.v.l);
549 return;
550 #if MPACK_EXTENSIONS
551 case mpack_type_ext:
552 mpack_snprintf(buffer, buffer_size, "ext of type %i, %u bytes",
553 mpack_tag_ext_exttype(&tag), mpack_tag_ext_length(&tag));
554 return;
555 #endif
556 case mpack_type_array:
557 mpack_snprintf(buffer, buffer_size, "array of %u elements", tag.v.n);
558 return;
559 case mpack_type_map:
560 mpack_snprintf(buffer, buffer_size, "map of %u key-value pairs", tag.v.n);
561 return;
562 }
563
564 mpack_snprintf(buffer, buffer_size, "unknown!");
565}
566
567void mpack_tag_debug_describe(mpack_tag_t tag, char* buffer, size_t buffer_size) {
568 mpack_assert(buffer_size > 0, "buffer size cannot be zero!");
569 buffer[0] = 0;
570
571 mpack_tag_debug_describe_impl(tag, buffer, buffer_size);
572
573 // We always null-terminate the buffer manually just in case the snprintf()
574 // function doesn't null-terminate when the string doesn't fit.
575 buffer[buffer_size - 1] = 0;
576}
577#endif
578
579
580
581#if MPACK_READ_TRACKING || MPACK_WRITE_TRACKING
582
583#ifndef MPACK_TRACKING_INITIAL_CAPACITY
584// seems like a reasonable number. we grow by doubling, and it only
585// needs to be as long as the maximum depth of the message.
586#define MPACK_TRACKING_INITIAL_CAPACITY 8
587#endif
588
589mpack_error_t mpack_track_init(mpack_track_t* track) {
590 track->count = 0;
591 track->capacity = MPACK_TRACKING_INITIAL_CAPACITY;
592 track->elements = (mpack_track_element_t*)MPACK_MALLOC(sizeof(mpack_track_element_t) * track->capacity);
593 if (track->elements == NULL)
594 return mpack_error_memory;
595 return mpack_ok;
596}
597
598mpack_error_t mpack_track_grow(mpack_track_t* track) {
599 mpack_assert(track->elements, "null track elements!");
600 mpack_assert(track->count == track->capacity, "incorrect growing?");
601
602 size_t new_capacity = track->capacity * 2;
603
604 mpack_track_element_t* new_elements = (mpack_track_element_t*)mpack_realloc(track->elements,
605 sizeof(mpack_track_element_t) * track->count, sizeof(mpack_track_element_t) * new_capacity);
606 if (new_elements == NULL)
607 return mpack_error_memory;
608
609 track->elements = new_elements;
610 track->capacity = new_capacity;
611 return mpack_ok;
612}
613
614mpack_error_t mpack_track_push(mpack_track_t* track, mpack_type_t type, uint32_t count) {
615 mpack_assert(track->elements, "null track elements!");
616 mpack_log("track pushing %s count %i\n", mpack_type_to_string(type), (int)count);
617
618 // grow if needed
619 if (track->count == track->capacity) {
620 mpack_error_t error = mpack_track_grow(track);
621 if (error != mpack_ok)
622 return error;
623 }
624
625 // insert new track
626 track->elements[track->count].type = type;
627 track->elements[track->count].left = count;
628 track->elements[track->count].builder = false;
629 track->elements[track->count].key_needs_value = false;
630 ++track->count;
631 return mpack_ok;
632}
633
634// TODO dedupe this
635mpack_error_t mpack_track_push_builder(mpack_track_t* track, mpack_type_t type) {
636 mpack_assert(track->elements, "null track elements!");
637 mpack_log("track pushing %s builder\n", mpack_type_to_string(type));
638
639 // grow if needed
640 if (track->count == track->capacity) {
641 mpack_error_t error = mpack_track_grow(track);
642 if (error != mpack_ok)
643 return error;
644 }
645
646 // insert new track
647 track->elements[track->count].type = type;
648 track->elements[track->count].left = 0;
649 track->elements[track->count].builder = true;
650 track->elements[track->count].key_needs_value = false;
651 ++track->count;
652 return mpack_ok;
653}
654
655static mpack_error_t mpack_track_pop_impl(mpack_track_t* track, mpack_type_t type, bool builder) {
656 mpack_assert(track->elements, "null track elements!");
657 mpack_log("track popping %s\n", mpack_type_to_string(type));
658
659 if (track->count == 0) {
660 mpack_break("attempting to close a %s but nothing was opened!", mpack_type_to_string(type));
661 return mpack_error_bug;
662 }
663
664 mpack_track_element_t* element = &track->elements[track->count - 1];
665
666 if (element->type != type) {
667 mpack_break("attempting to close a %s but the open element is a %s!",
668 mpack_type_to_string(type), mpack_type_to_string(element->type));
669 return mpack_error_bug;
670 }
671
672 if (element->key_needs_value) {
673 mpack_assert(type == mpack_type_map, "key_needs_value can only be true for maps!");
674 mpack_break("attempting to close a %s but an odd number of elements were written",
675 mpack_type_to_string(type));
676 return mpack_error_bug;
677 }
678
679 if (element->left != 0) {
680 mpack_break("attempting to close a %s but there are %i %s left",
681 mpack_type_to_string(type), element->left,
682 (type == mpack_type_map || type == mpack_type_array) ? "elements" : "bytes");
683 return mpack_error_bug;
684 }
685
686 if (element->builder != builder) {
687 mpack_break("attempting to pop a %sbuilder but the open element is %sa builder",
688 builder ? "" : "non-",
689 element->builder ? "" : "not ");
690 return mpack_error_bug;
691 }
692
693 --track->count;
694 return mpack_ok;
695}
696
697mpack_error_t mpack_track_pop(mpack_track_t* track, mpack_type_t type) {
698 return mpack_track_pop_impl(track, type, false);
699}
700
701mpack_error_t mpack_track_pop_builder(mpack_track_t* track, mpack_type_t type) {
702 return mpack_track_pop_impl(track, type, true);
703}
704
705mpack_error_t mpack_track_peek_element(mpack_track_t* track, bool read) {
706 MPACK_UNUSED(read);
707 mpack_assert(track->elements, "null track elements!");
708
709 // if there are no open elements, that's fine, we can read/write elements at will
710 if (track->count == 0)
711 return mpack_ok;
712
713 mpack_track_element_t* element = &track->elements[track->count - 1];
714
715 if (element->type != mpack_type_map && element->type != mpack_type_array) {
716 mpack_break("elements cannot be %s within an %s", read ? "read" : "written",
717 mpack_type_to_string(element->type));
718 return mpack_error_bug;
719 }
720
721 if (!element->builder && element->left == 0 && !element->key_needs_value) {
722 mpack_break("too many elements %s for %s", read ? "read" : "written",
723 mpack_type_to_string(element->type));
724 return mpack_error_bug;
725 }
726
727 return mpack_ok;
728}
729
730mpack_error_t mpack_track_element(mpack_track_t* track, bool read) {
731 mpack_error_t error = mpack_track_peek_element(track, read);
732 if (track->count == 0 || error != mpack_ok)
733 return error;
734
735 mpack_track_element_t* element = &track->elements[track->count - 1];
736
737 if (element->type == mpack_type_map) {
738 if (!element->key_needs_value) {
739 element->key_needs_value = true;
740 return mpack_ok; // don't decrement
741 }
742 element->key_needs_value = false;
743 }
744
745 if (!element->builder)
746 --element->left;
747 return mpack_ok;
748}
749
750mpack_error_t mpack_track_bytes(mpack_track_t* track, bool read, size_t count) {
751 MPACK_UNUSED(read);
752 mpack_assert(track->elements, "null track elements!");
753
754 if (count > MPACK_UINT32_MAX) {
755 mpack_break("%s more bytes than could possibly fit in a str/bin/ext!",
756 read ? "reading" : "writing");
757 return mpack_error_bug;
758 }
759
760 if (track->count == 0) {
761 mpack_break("bytes cannot be %s with no open bin, str or ext", read ? "read" : "written");
762 return mpack_error_bug;
763 }
764
765 mpack_track_element_t* element = &track->elements[track->count - 1];
766
767 if (element->type == mpack_type_map || element->type == mpack_type_array) {
768 mpack_break("bytes cannot be %s within an %s", read ? "read" : "written",
769 mpack_type_to_string(element->type));
770 return mpack_error_bug;
771 }
772
773 if (element->left < count) {
774 mpack_break("too many bytes %s for %s", read ? "read" : "written",
775 mpack_type_to_string(element->type));
776 return mpack_error_bug;
777 }
778
779 element->left -= (uint32_t)count;
780 return mpack_ok;
781}
782
783mpack_error_t mpack_track_str_bytes_all(mpack_track_t* track, bool read, size_t count) {
784 mpack_error_t error = mpack_track_bytes(track, read, count);
785 if (error != mpack_ok)
786 return error;
787
788 mpack_track_element_t* element = &track->elements[track->count - 1];
789
790 if (element->type != mpack_type_str) {
791 mpack_break("the open type must be a string, not a %s", mpack_type_to_string(element->type));
792 return mpack_error_bug;
793 }
794
795 if (element->left != 0) {
796 mpack_break("not all bytes were read; the wrong byte count was requested for a string read.");
797 return mpack_error_bug;
798 }
799
800 return mpack_ok;
801}
802
803mpack_error_t mpack_track_check_empty(mpack_track_t* track) {
804 if (track->count != 0) {
805 mpack_break("unclosed %s", mpack_type_to_string(track->elements[0].type));
806 return mpack_error_bug;
807 }
808 return mpack_ok;
809}
810
811mpack_error_t mpack_track_destroy(mpack_track_t* track, bool cancel) {
812 mpack_error_t error = cancel ? mpack_ok : mpack_track_check_empty(track);
813 if (track->elements) {
814 MPACK_FREE(track->elements);
815 track->elements = NULL;
816 }
817 return error;
818}
819#endif
820
821
822
823static bool mpack_utf8_check_impl(const uint8_t* str, size_t count, bool allow_null) {
824 while (count > 0) {
825 uint8_t lead = str[0];
826
827 // NUL
828 if (!allow_null && lead == '\0') // we don't allow NUL bytes in MPack C-strings
829 return false;
830
831 // ASCII
832 if (lead <= 0x7F) {
833 ++str;
834 --count;
835
836 // 2-byte sequence
837 } else if ((lead & 0xE0) == 0xC0) {
838 if (count < 2) // truncated sequence
839 return false;
840
841 uint8_t cont = str[1];
842 if ((cont & 0xC0) != 0x80) // not a continuation byte
843 return false;
844
845 str += 2;
846 count -= 2;
847
848 uint32_t z = ((uint32_t)(lead & ~0xE0) << 6) |
849 (uint32_t)(cont & ~0xC0);
850
851 if (z < 0x80) // overlong sequence
852 return false;
853
854 // 3-byte sequence
855 } else if ((lead & 0xF0) == 0xE0) {
856 if (count < 3) // truncated sequence
857 return false;
858
859 uint8_t cont1 = str[1];
860 if ((cont1 & 0xC0) != 0x80) // not a continuation byte
861 return false;
862 uint8_t cont2 = str[2];
863 if ((cont2 & 0xC0) != 0x80) // not a continuation byte
864 return false;
865
866 str += 3;
867 count -= 3;
868
869 uint32_t z = ((uint32_t)(lead & ~0xF0) << 12) |
870 ((uint32_t)(cont1 & ~0xC0) << 6) |
871 (uint32_t)(cont2 & ~0xC0);
872
873 if (z < 0x800) // overlong sequence
874 return false;
875 if (z >= 0xD800 && z <= 0xDFFF) // surrogate
876 return false;
877
878 // 4-byte sequence
879 } else if ((lead & 0xF8) == 0xF0) {
880 if (count < 4) // truncated sequence
881 return false;
882
883 uint8_t cont1 = str[1];
884 if ((cont1 & 0xC0) != 0x80) // not a continuation byte
885 return false;
886 uint8_t cont2 = str[2];
887 if ((cont2 & 0xC0) != 0x80) // not a continuation byte
888 return false;
889 uint8_t cont3 = str[3];
890 if ((cont3 & 0xC0) != 0x80) // not a continuation byte
891 return false;
892
893 str += 4;
894 count -= 4;
895
896 uint32_t z = ((uint32_t)(lead & ~0xF8) << 18) |
897 ((uint32_t)(cont1 & ~0xC0) << 12) |
898 ((uint32_t)(cont2 & ~0xC0) << 6) |
899 (uint32_t)(cont3 & ~0xC0);
900
901 if (z < 0x10000) // overlong sequence
902 return false;
903 if (z > 0x10FFFF) // codepoint limit
904 return false;
905
906 } else {
907 return false; // continuation byte without a lead, or lead for a 5-byte sequence or longer
908 }
909 }
910 return true;
911}
912
913bool mpack_utf8_check(const char* str, size_t bytes) {
914 return mpack_utf8_check_impl((const uint8_t*)str, bytes, true);
915}
916
917bool mpack_utf8_check_no_null(const char* str, size_t bytes) {
918 return mpack_utf8_check_impl((const uint8_t*)str, bytes, false);
919}
920
921bool mpack_str_check_no_null(const char* str, size_t bytes) {
922 size_t i;
923 for (i = 0; i < bytes; ++i)
924 if (str[i] == '\0')
925 return false;
926 return true;
927}
928
929#if MPACK_DEBUG && MPACK_STDIO
930void mpack_print_append(mpack_print_t* print, const char* data, size_t count) {
931
932 // copy whatever fits into the buffer
933 size_t copy = print->size - print->count;
934 if (copy > count)
935 copy = count;
936 mpack_memcpy(print->buffer + print->count, data, copy);
937 print->count += copy;
938 data += copy;
939 count -= copy;
940
941 // if we don't need to flush or can't flush there's nothing else to do
942 if (count == 0 || print->callback == NULL)
943 return;
944
945 // flush the buffer
946 print->callback(print->context, print->buffer, print->count);
947
948 if (count > print->size / 2) {
949 // flush the rest of the data
950 print->count = 0;
951 print->callback(print->context, data, count);
952 } else {
953 // copy the rest of the data into the buffer
954 mpack_memcpy(print->buffer, data, count);
955 print->count = count;
956 }
957
958}
959
960void mpack_print_flush(mpack_print_t* print) {
961 if (print->count > 0 && print->callback != NULL) {
962 print->callback(print->context, print->buffer, print->count);
963 print->count = 0;
964 }
965}
966
967void mpack_print_file_callback(void* context, const char* data, size_t count) {
968 FILE* file = (FILE*)context;
969 fwrite(data, 1, count, file);
970}
971#endif
972
973MPACK_SILENCE_WARNINGS_END
974
975/* mpack/mpack-writer.c.c */
976
977#define MPACK_INTERNAL 1
978
979/* #include "mpack-writer.h" */
980
981MPACK_SILENCE_WARNINGS_BEGIN
982
983#if MPACK_WRITER
984
985#if MPACK_BUILDER
986static void mpack_builder_flush(mpack_writer_t* writer);
987#endif
988
989#if MPACK_WRITE_TRACKING
990static void mpack_writer_flag_if_error(mpack_writer_t* writer, mpack_error_t error) {
991 if (error != mpack_ok)
992 mpack_writer_flag_error(writer, error);
993}
994
995void mpack_writer_track_push(mpack_writer_t* writer, mpack_type_t type, uint32_t count) {
996 if (writer->error == mpack_ok)
997 mpack_writer_flag_if_error(writer, mpack_track_push(&writer->track, type, count));
998}
999
1000void mpack_writer_track_push_builder(mpack_writer_t* writer, mpack_type_t type) {
1001 if (writer->error == mpack_ok)
1002 mpack_writer_flag_if_error(writer, mpack_track_push_builder(&writer->track, type));
1003}
1004
1005void mpack_writer_track_pop(mpack_writer_t* writer, mpack_type_t type) {
1006 if (writer->error == mpack_ok)
1007 mpack_writer_flag_if_error(writer, mpack_track_pop(&writer->track, type));
1008}
1009
1010void mpack_writer_track_pop_builder(mpack_writer_t* writer, mpack_type_t type) {
1011 if (writer->error == mpack_ok)
1012 mpack_writer_flag_if_error(writer, mpack_track_pop_builder(&writer->track, type));
1013}
1014
1015void mpack_writer_track_bytes(mpack_writer_t* writer, size_t count) {
1016 if (writer->error == mpack_ok)
1017 mpack_writer_flag_if_error(writer, mpack_track_bytes(&writer->track, false, count));
1018}
1019#endif
1020
1021// This should probably be renamed. It's not solely used for tracking.
1022static inline void mpack_writer_track_element(mpack_writer_t* writer) {
1023 (void)writer;
1024
1025 #if MPACK_WRITE_TRACKING
1026 if (writer->error == mpack_ok)
1027 mpack_writer_flag_if_error(writer, mpack_track_element(&writer->track, false));
1028 #endif
1029
1030 #if MPACK_BUILDER
1031 if (writer->builder.current_build != NULL) {
1032 mpack_build_t* build = writer->builder.current_build;
1033 // We only track this write if it's not nested within another non-build
1034 // map or array.
1035 if (build->nested_compound_elements == 0) {
1036 if (build->type != mpack_type_map) {
1037 ++build->count;
1038 mpack_log("adding element to build %p, now %u elements\n", (void*)build, build->count);
1039 } else if (build->key_needs_value) {
1040 build->key_needs_value = false;
1041 ++build->count;
1042 } else {
1043 build->key_needs_value = true;
1044 }
1045 }
1046 }
1047 #endif
1048}
1049
1050static void mpack_writer_clear(mpack_writer_t* writer) {
1051 #if MPACK_COMPATIBILITY
1052 writer->version = mpack_version_current;
1053 #endif
1054 writer->flush = NULL;
1055 writer->error_fn = NULL;
1056 writer->teardown = NULL;
1057 writer->context = NULL;
1058
1059 writer->buffer = NULL;
1060 writer->position = NULL;
1061 writer->end = NULL;
1062 writer->error = mpack_ok;
1063
1064 #if MPACK_WRITE_TRACKING
1065 mpack_memset(&writer->track, 0, sizeof(writer->track));
1066 #endif
1067
1068 #if MPACK_BUILDER
1069 writer->builder.current_build = NULL;
1070 writer->builder.latest_build = NULL;
1071 writer->builder.current_page = NULL;
1072 writer->builder.pages = NULL;
1073 writer->builder.stash_buffer = NULL;
1074 writer->builder.stash_position = NULL;
1075 writer->builder.stash_end = NULL;
1076 #endif
1077}
1078
1079void mpack_writer_init(mpack_writer_t* writer, char* buffer, size_t size) {
1080 mpack_assert(buffer != NULL, "cannot initialize writer with empty buffer");
1081 mpack_writer_clear(writer);
1082 writer->buffer = buffer;
1083 writer->position = buffer;
1084 writer->end = writer->buffer + size;
1085
1086 #if MPACK_WRITE_TRACKING
1087 mpack_writer_flag_if_error(writer, mpack_track_init(&writer->track));
1088 #endif
1089
1090 mpack_log("===========================\n");
1091 mpack_log("initializing writer with buffer size %i\n", (int)size);
1092}
1093
1094void mpack_writer_init_error(mpack_writer_t* writer, mpack_error_t error) {
1095 mpack_writer_clear(writer);
1096 writer->error = error;
1097
1098 mpack_log("===========================\n");
1099 mpack_log("initializing writer in error state %i\n", (int)error);
1100}
1101
1102void mpack_writer_set_flush(mpack_writer_t* writer, mpack_writer_flush_t flush) {
1103 MPACK_STATIC_ASSERT(MPACK_WRITER_MINIMUM_BUFFER_SIZE >= MPACK_MAXIMUM_TAG_SIZE,
1104 "minimum buffer size must fit any tag!");
1105 MPACK_STATIC_ASSERT(31 + MPACK_TAG_SIZE_FIXSTR >= MPACK_WRITER_MINIMUM_BUFFER_SIZE,
1106 "minimum buffer size must fit the largest possible fixstr!");
1107
1108 if (mpack_writer_buffer_size(writer) < MPACK_WRITER_MINIMUM_BUFFER_SIZE) {
1109 mpack_break("buffer size is %i, but minimum buffer size for flush is %i",
1110 (int)mpack_writer_buffer_size(writer), MPACK_WRITER_MINIMUM_BUFFER_SIZE);
1111 mpack_writer_flag_error(writer, mpack_error_bug);
1112 return;
1113 }
1114
1115 writer->flush = flush;
1116}
1117
1118#ifdef MPACK_MALLOC
1119typedef struct mpack_growable_writer_t {
1120 char** target_data;
1121 size_t* target_size;
1122} mpack_growable_writer_t;
1123
1124static char* mpack_writer_get_reserved(mpack_writer_t* writer) {
1125 // This is in a separate function in order to avoid false strict aliasing
1126 // warnings. We aren't actually violating strict aliasing (the reserved
1127 // space is only ever dereferenced as an mpack_growable_writer_t.)
1128 return (char*)writer->reserved;
1129}
1130
1131static void mpack_growable_writer_flush(mpack_writer_t* writer, const char* data, size_t count) {
1132
1133 // This is an intrusive flush function which modifies the writer's buffer
1134 // in response to a flush instead of emptying it in order to add more
1135 // capacity for data. This removes the need to copy data from a fixed buffer
1136 // into a growable one, improving performance.
1137 //
1138 // There are three ways flush can be called:
1139 // - flushing the buffer during writing (used is zero, count is all data, data is buffer)
1140 // - flushing extra data during writing (used is all flushed data, count is extra data, data is not buffer)
1141 // - flushing during teardown (used and count are both all flushed data, data is buffer)
1142 //
1143 // In the first two cases, we grow the buffer by at least double, enough
1144 // to ensure that new data will fit. We ignore the teardown flush.
1145
1146 if (data == writer->buffer) {
1147
1148 // teardown, do nothing
1149 if (mpack_writer_buffer_used(writer) == count)
1150 return;
1151
1152 // otherwise leave the data in the buffer and just grow
1153 writer->position = writer->buffer + count;
1154 count = 0;
1155 }
1156
1157 size_t used = mpack_writer_buffer_used(writer);
1158 size_t size = mpack_writer_buffer_size(writer);
1159
1160 mpack_log("flush size %i used %i data %p buffer %p\n",
1161 (int)count, (int)used, data, writer->buffer);
1162
1163 mpack_assert(data == writer->buffer || used + count > size,
1164 "extra flush for %i but there is %i space left in the buffer! (%i/%i)",
1165 (int)count, (int)mpack_writer_buffer_left(writer), (int)used, (int)size);
1166
1167 // grow to fit the data
1168 // TODO: this really needs to correctly test for overflow
1169 size_t new_size = size * 2;
1170 while (new_size < used + count)
1171 new_size *= 2;
1172
1173 mpack_log("flush growing buffer size from %i to %i\n", (int)size, (int)new_size);
1174
1175 // grow the buffer
1176 char* new_buffer = (char*)mpack_realloc(writer->buffer, used, new_size);
1177 if (new_buffer == NULL) {
1178 mpack_writer_flag_error(writer, mpack_error_memory);
1179 return;
1180 }
1181 writer->position = new_buffer + used;
1182 writer->buffer = new_buffer;
1183 writer->end = writer->buffer + new_size;
1184
1185 // append the extra data
1186 if (count > 0) {
1187 mpack_memcpy(writer->position, data, count);
1188 writer->position += count;
1189 }
1190
1191 mpack_log("new buffer %p, used %i\n", new_buffer, (int)mpack_writer_buffer_used(writer));
1192}
1193
1194static void mpack_growable_writer_teardown(mpack_writer_t* writer) {
1195 mpack_growable_writer_t* growable_writer = (mpack_growable_writer_t*)mpack_writer_get_reserved(writer);
1196
1197 if (mpack_writer_error(writer) == mpack_ok) {
1198
1199 // shrink the buffer to an appropriate size if the data is
1200 // much smaller than the buffer
1201 if (mpack_writer_buffer_used(writer) < mpack_writer_buffer_size(writer) / 2) {
1202 size_t used = mpack_writer_buffer_used(writer);
1203
1204 // We always return a non-null pointer that must be freed, even if
1205 // nothing was written. malloc() and realloc() do not necessarily
1206 // do this so we enforce it ourselves.
1207 size_t size = (used != 0) ? used : 1;
1208
1209 char* buffer = (char*)mpack_realloc(writer->buffer, used, size);
1210 if (!buffer) {
1211 MPACK_FREE(writer->buffer);
1212 mpack_writer_flag_error(writer, mpack_error_memory);
1213 return;
1214 }
1215 writer->buffer = buffer;
1216 writer->end = (writer->position = writer->buffer + used);
1217 }
1218
1219 *growable_writer->target_data = writer->buffer;
1220 *growable_writer->target_size = mpack_writer_buffer_used(writer);
1221 writer->buffer = NULL;
1222
1223 } else if (writer->buffer) {
1224 MPACK_FREE(writer->buffer);
1225 writer->buffer = NULL;
1226 }
1227
1228 writer->context = NULL;
1229}
1230
1231void mpack_writer_init_growable(mpack_writer_t* writer, char** target_data, size_t* target_size) {
1232 mpack_assert(target_data != NULL, "cannot initialize writer without a destination for the data");
1233 mpack_assert(target_size != NULL, "cannot initialize writer without a destination for the size");
1234
1235 *target_data = NULL;
1236 *target_size = 0;
1237
1238 MPACK_STATIC_ASSERT(sizeof(mpack_growable_writer_t) <= sizeof(writer->reserved),
1239 "not enough reserved space for growable writer!");
1240 mpack_growable_writer_t* growable_writer = (mpack_growable_writer_t*)mpack_writer_get_reserved(writer);
1241
1242 growable_writer->target_data = target_data;
1243 growable_writer->target_size = target_size;
1244
1245 size_t capacity = MPACK_BUFFER_SIZE;
1246 char* buffer = (char*)MPACK_MALLOC(capacity);
1247 if (buffer == NULL) {
1248 mpack_writer_init_error(writer, mpack_error_memory);
1249 return;
1250 }
1251
1252 mpack_writer_init(writer, buffer, capacity);
1253 mpack_writer_set_flush(writer, mpack_growable_writer_flush);
1254 mpack_writer_set_teardown(writer, mpack_growable_writer_teardown);
1255}
1256#endif
1257
1258#if MPACK_STDIO
1259static void mpack_file_writer_flush(mpack_writer_t* writer, const char* buffer, size_t count) {
1260 FILE* file = (FILE*)writer->context;
1261 size_t written = fwrite((const void*)buffer, 1, count, file);
1262 if (written != count)
1263 mpack_writer_flag_error(writer, mpack_error_io);
1264}
1265
1266static void mpack_file_writer_teardown(mpack_writer_t* writer) {
1267 MPACK_FREE(writer->buffer);
1268 writer->buffer = NULL;
1269 writer->context = NULL;
1270}
1271
1272static void mpack_file_writer_teardown_close(mpack_writer_t* writer) {
1273 FILE* file = (FILE*)writer->context;
1274
1275 if (file) {
1276 int ret = fclose(file);
1277 if (ret != 0)
1278 mpack_writer_flag_error(writer, mpack_error_io);
1279 }
1280
1281 mpack_file_writer_teardown(writer);
1282}
1283
1284void mpack_writer_init_stdfile(mpack_writer_t* writer, FILE* file, bool close_when_done) {
1285 mpack_assert(file != NULL, "file is NULL");
1286
1287 size_t capacity = MPACK_BUFFER_SIZE;
1288 char* buffer = (char*)MPACK_MALLOC(capacity);
1289 if (buffer == NULL) {
1290 mpack_writer_init_error(writer, mpack_error_memory);
1291 if (close_when_done) {
1292 fclose(file);
1293 }
1294 return;
1295 }
1296
1297 mpack_writer_init(writer, buffer, capacity);
1298 mpack_writer_set_context(writer, file);
1299 mpack_writer_set_flush(writer, mpack_file_writer_flush);
1300 mpack_writer_set_teardown(writer, close_when_done ?
1301 mpack_file_writer_teardown_close :
1302 mpack_file_writer_teardown);
1303}
1304
1305void mpack_writer_init_filename(mpack_writer_t* writer, const char* filename) {
1306 mpack_assert(filename != NULL, "filename is NULL");
1307
1308 FILE* file = fopen(filename, "wb");
1309 if (file == NULL) {
1310 mpack_writer_init_error(writer, mpack_error_io);
1311 return;
1312 }
1313
1314 mpack_writer_init_stdfile(writer, file, true);
1315}
1316#endif
1317
1318void mpack_writer_flag_error(mpack_writer_t* writer, mpack_error_t error) {
1319 mpack_log("writer %p setting error %i: %s\n", (void*)writer, (int)error, mpack_error_to_string(error));
1320
1321 if (writer->error == mpack_ok) {
1322 writer->error = error;
1323 if (writer->error_fn)
1324 writer->error_fn(writer, writer->error);
1325 }
1326}
1327
1328MPACK_STATIC_INLINE void mpack_writer_flush_unchecked(mpack_writer_t* writer) {
1329 // This is a bit ugly; we reset used before calling flush so that
1330 // a flush function can distinguish between flushing the buffer
1331 // versus flushing external data. see mpack_growable_writer_flush()
1332 size_t used = mpack_writer_buffer_used(writer);
1333 writer->position = writer->buffer;
1334 writer->flush(writer, writer->buffer, used);
1335}
1336
1337void mpack_writer_flush_message(mpack_writer_t* writer) {
1338 if (writer->error != mpack_ok)
1339 return;
1340
1341 #if MPACK_WRITE_TRACKING
1342 // You cannot flush while there are elements open.
1343 mpack_writer_flag_if_error(writer, mpack_track_check_empty(&writer->track));
1344 if (writer->error != mpack_ok)
1345 return;
1346 #endif
1347
1348 #if MPACK_BUILDER
1349 if (writer->builder.current_build != NULL) {
1350 mpack_break("cannot call mpack_writer_flush_message() while there are elements open!");
1351 mpack_writer_flag_error(writer, mpack_error_bug);
1352 return;
1353 }
1354 #endif
1355
1356 if (writer->flush == NULL) {
1357 mpack_break("cannot call mpack_writer_flush_message() without a flush function!");
1358 mpack_writer_flag_error(writer, mpack_error_bug);
1359 return;
1360 }
1361
1362 if (mpack_writer_buffer_used(writer) > 0)
1363 mpack_writer_flush_unchecked(writer);
1364}
1365
1366// Ensures there are at least count bytes free in the buffer. This
1367// will flag an error if the flush function fails to make enough
1368// room in the buffer.
1369MPACK_NOINLINE static bool mpack_writer_ensure(mpack_writer_t* writer, size_t count) {
1370 mpack_assert(count != 0, "cannot ensure zero bytes!");
1371 mpack_assert(count <= MPACK_WRITER_MINIMUM_BUFFER_SIZE,
1372 "cannot ensure %i bytes, this is more than the minimum buffer size %i!",
1373 (int)count, (int)MPACK_WRITER_MINIMUM_BUFFER_SIZE);
1374 mpack_assert(count > mpack_writer_buffer_left(writer),
1375 "request to ensure %i bytes but there are already %i left in the buffer!",
1376 (int)count, (int)mpack_writer_buffer_left(writer));
1377
1378 mpack_log("ensuring %i bytes, %i left\n", (int)count, (int)mpack_writer_buffer_left(writer));
1379
1380 if (mpack_writer_error(writer) != mpack_ok)
1381 return false;
1382
1383 #if MPACK_BUILDER
1384 // if we have a build in progress, we just ask the builder for a page.
1385 // either it will have space for a tag, or it will flag a memory error.
1386 if (writer->builder.current_build != NULL) {
1387 mpack_builder_flush(writer);
1388 return mpack_writer_error(writer) == mpack_ok;
1389 }
1390 #endif
1391
1392 if (writer->flush == NULL) {
1393 mpack_writer_flag_error(writer, mpack_error_too_big);
1394 return false;
1395 }
1396
1397 mpack_writer_flush_unchecked(writer);
1398 if (mpack_writer_error(writer) != mpack_ok)
1399 return false;
1400
1401 if (mpack_writer_buffer_left(writer) >= count)
1402 return true;
1403
1404 mpack_writer_flag_error(writer, mpack_error_io);
1405 return false;
1406}
1407
1408// Writes encoded bytes to the buffer when we already know the data
1409// does not fit in the buffer (i.e. it straddles the edge of the
1410// buffer.) If there is a flush function, it is guaranteed to be
1411// called; otherwise mpack_error_too_big is raised.
1412MPACK_NOINLINE static void mpack_write_native_straddle(mpack_writer_t* writer, const char* p, size_t count) {
1413 mpack_assert(count == 0 || p != NULL, "data pointer for %i bytes is NULL", (int)count);
1414
1415 if (mpack_writer_error(writer) != mpack_ok)
1416 return;
1417 mpack_log("big write for %i bytes from %p, %i space left in buffer\n",
1418 (int)count, p, (int)mpack_writer_buffer_left(writer));
1419 mpack_assert(count > mpack_writer_buffer_left(writer),
1420 "big write requested for %i bytes, but there is %i available "
1421 "space in buffer. should have called mpack_write_native() instead",
1422 (int)count, (int)(mpack_writer_buffer_left(writer)));
1423
1424 #if MPACK_BUILDER
1425 // if we have a build in progress, we can't flush. we need to copy all
1426 // bytes into as many build buffer pages as it takes.
1427 if (writer->builder.current_build != NULL) {
1428 while (true) {
1429 size_t step = (size_t)(writer->end - writer->position);
1430 if (step > count)
1431 step = count;
1432 mpack_memcpy(writer->position, p, step);
1433 writer->position += step;
1434 p += step;
1435 count -= step;
1436
1437 if (count == 0)
1438 return;
1439
1440 mpack_builder_flush(writer);
1441 if (mpack_writer_error(writer) != mpack_ok)
1442 return;
1443 mpack_assert(writer->position != writer->end);
1444 }
1445 }
1446 #endif
1447
1448 // we'll need a flush function
1449 if (!writer->flush) {
1450 mpack_writer_flag_error(writer, mpack_error_too_big);
1451 return;
1452 }
1453
1454 // flush the buffer
1455 mpack_writer_flush_unchecked(writer);
1456 if (mpack_writer_error(writer) != mpack_ok)
1457 return;
1458
1459 // note that an intrusive flush function (such as mpack_growable_writer_flush())
1460 // may have changed size and/or reset used to a non-zero value. we treat both as
1461 // though they may have changed, and there may still be data in the buffer.
1462
1463 // flush the extra data directly if it doesn't fit in the buffer
1464 if (count > mpack_writer_buffer_left(writer)) {
1465 writer->flush(writer, p, count);
1466 if (mpack_writer_error(writer) != mpack_ok)
1467 return;
1468 } else {
1469 mpack_memcpy(writer->position, p, count);
1470 writer->position += count;
1471 }
1472}
1473
1474// Writes encoded bytes to the buffer, flushing if necessary.
1475MPACK_STATIC_INLINE void mpack_write_native(mpack_writer_t* writer, const char* p, size_t count) {
1476 mpack_assert(count == 0 || p != NULL, "data pointer for %i bytes is NULL", (int)count);
1477
1478 if (mpack_writer_buffer_left(writer) < count) {
1479 mpack_write_native_straddle(writer, p, count);
1480 } else {
1481 mpack_memcpy(writer->position, p, count);
1482 writer->position += count;
1483 }
1484}
1485
1486mpack_error_t mpack_writer_destroy(mpack_writer_t* writer) {
1487
1488 // clean up tracking, asserting if we're not already in an error state
1489 #if MPACK_WRITE_TRACKING
1490 mpack_track_destroy(&writer->track, writer->error != mpack_ok);
1491 #endif
1492
1493 // flush any outstanding data
1494 if (mpack_writer_error(writer) == mpack_ok && mpack_writer_buffer_used(writer) != 0 && writer->flush != NULL) {
1495 writer->flush(writer, writer->buffer, mpack_writer_buffer_used(writer));
1496 writer->flush = NULL;
1497 }
1498
1499 if (writer->teardown) {
1500 writer->teardown(writer);
1501 writer->teardown = NULL;
1502 }
1503
1504 return writer->error;
1505}
1506
1507void mpack_write_tag(mpack_writer_t* writer, mpack_tag_t value) {
1508 switch (value.type) {
1509 case mpack_type_missing:
1510 mpack_break("cannot write a missing value!");
1511 mpack_writer_flag_error(writer, mpack_error_bug);
1512 return;
1513
1514 case mpack_type_nil: mpack_write_nil (writer); return;
1515 case mpack_type_bool: mpack_write_bool (writer, value.v.b); return;
1516 case mpack_type_int: mpack_write_int (writer, value.v.i); return;
1517 case mpack_type_uint: mpack_write_uint (writer, value.v.u); return;
1518
1519 case mpack_type_float:
1520 #if MPACK_FLOAT
1521 mpack_write_float
1522 #else
1523 mpack_write_raw_float
1524 #endif
1525 (writer, value.v.f);
1526 return;
1527 case mpack_type_double:
1528 #if MPACK_DOUBLE
1529 mpack_write_double
1530 #else
1531 mpack_write_raw_double
1532 #endif
1533 (writer, value.v.d);
1534 return;
1535
1536 case mpack_type_str: mpack_start_str(writer, value.v.l); return;
1537 case mpack_type_bin: mpack_start_bin(writer, value.v.l); return;
1538
1539 #if MPACK_EXTENSIONS
1540 case mpack_type_ext:
1541 mpack_start_ext(writer, mpack_tag_ext_exttype(&value), mpack_tag_ext_length(&value));
1542 return;
1543 #endif
1544
1545 case mpack_type_array: mpack_start_array(writer, value.v.n); return;
1546 case mpack_type_map: mpack_start_map(writer, value.v.n); return;
1547 }
1548
1549 mpack_break("unrecognized type %i", (int)value.type);
1550 mpack_writer_flag_error(writer, mpack_error_bug);
1551}
1552
1553MPACK_STATIC_INLINE void mpack_write_byte_element(mpack_writer_t* writer, char value) {
1554 mpack_writer_track_element(writer);
1555 if (MPACK_LIKELY(mpack_writer_buffer_left(writer) >= 1) || mpack_writer_ensure(writer, 1))
1556 *(writer->position++) = value;
1557}
1558
1559void mpack_write_nil(mpack_writer_t* writer) {
1560 mpack_write_byte_element(writer, (char)0xc0);
1561}
1562
1563void mpack_write_bool(mpack_writer_t* writer, bool value) {
1564 mpack_write_byte_element(writer, (char)(0xc2 | (value ? 1 : 0)));
1565}
1566
1567void mpack_write_true(mpack_writer_t* writer) {
1568 mpack_write_byte_element(writer, (char)0xc3);
1569}
1570
1571void mpack_write_false(mpack_writer_t* writer) {
1572 mpack_write_byte_element(writer, (char)0xc2);
1573}
1574
1575void mpack_write_object_bytes(mpack_writer_t* writer, const char* data, size_t bytes) {
1576 mpack_writer_track_element(writer);
1577 mpack_write_native(writer, data, bytes);
1578}
1579
1580/*
1581 * Encode functions
1582 */
1583
1584MPACK_STATIC_INLINE void mpack_encode_fixuint(char* p, uint8_t value) {
1585 mpack_assert(value <= 127);
1586 mpack_store_u8(p, value);
1587}
1588
1589MPACK_STATIC_INLINE void mpack_encode_u8(char* p, uint8_t value) {
1590 mpack_assert(value > 127);
1591 mpack_store_u8(p, 0xcc);
1592 mpack_store_u8(p + 1, value);
1593}
1594
1595MPACK_STATIC_INLINE void mpack_encode_u16(char* p, uint16_t value) {
1596 mpack_assert(value > MPACK_UINT8_MAX);
1597 mpack_store_u8(p, 0xcd);
1598 mpack_store_u16(p + 1, value);
1599}
1600
1601MPACK_STATIC_INLINE void mpack_encode_u32(char* p, uint32_t value) {
1602 mpack_assert(value > MPACK_UINT16_MAX);
1603 mpack_store_u8(p, 0xce);
1604 mpack_store_u32(p + 1, value);
1605}
1606
1607MPACK_STATIC_INLINE void mpack_encode_u64(char* p, uint64_t value) {
1608 mpack_assert(value > MPACK_UINT32_MAX);
1609 mpack_store_u8(p, 0xcf);
1610 mpack_store_u64(p + 1, value);
1611}
1612
1613MPACK_STATIC_INLINE void mpack_encode_fixint(char* p, int8_t value) {
1614 // this can encode positive or negative fixints
1615 mpack_assert(value >= -32);
1616 mpack_store_i8(p, value);
1617}
1618
1619MPACK_STATIC_INLINE void mpack_encode_i8(char* p, int8_t value) {
1620 mpack_assert(value < -32);
1621 mpack_store_u8(p, 0xd0);
1622 mpack_store_i8(p + 1, value);
1623}
1624
1625MPACK_STATIC_INLINE void mpack_encode_i16(char* p, int16_t value) {
1626 mpack_assert(value < MPACK_INT8_MIN);
1627 mpack_store_u8(p, 0xd1);
1628 mpack_store_i16(p + 1, value);
1629}
1630
1631MPACK_STATIC_INLINE void mpack_encode_i32(char* p, int32_t value) {
1632 mpack_assert(value < MPACK_INT16_MIN);
1633 mpack_store_u8(p, 0xd2);
1634 mpack_store_i32(p + 1, value);
1635}
1636
1637MPACK_STATIC_INLINE void mpack_encode_i64(char* p, int64_t value) {
1638 mpack_assert(value < MPACK_INT32_MIN);
1639 mpack_store_u8(p, 0xd3);
1640 mpack_store_i64(p + 1, value);
1641}
1642
1643#if MPACK_FLOAT
1644MPACK_STATIC_INLINE void mpack_encode_float(char* p, float value) {
1645 mpack_store_u8(p, 0xca);
1646 mpack_store_float(p + 1, value);
1647}
1648#else
1649MPACK_STATIC_INLINE void mpack_encode_raw_float(char* p, uint32_t value) {
1650 mpack_store_u8(p, 0xca);
1651 mpack_store_u32(p + 1, value);
1652}
1653#endif
1654
1655#if MPACK_DOUBLE
1656MPACK_STATIC_INLINE void mpack_encode_double(char* p, double value) {
1657 mpack_store_u8(p, 0xcb);
1658 mpack_store_double(p + 1, value);
1659}
1660#else
1661MPACK_STATIC_INLINE void mpack_encode_raw_double(char* p, uint64_t value) {
1662 mpack_store_u8(p, 0xcb);
1663 mpack_store_u64(p + 1, value);
1664}
1665#endif
1666
1667MPACK_STATIC_INLINE void mpack_encode_fixarray(char* p, uint8_t count) {
1668 mpack_assert(count <= 15);
1669 mpack_store_u8(p, (uint8_t)(0x90 | count));
1670}
1671
1672MPACK_STATIC_INLINE void mpack_encode_array16(char* p, uint16_t count) {
1673 mpack_assert(count > 15);
1674 mpack_store_u8(p, 0xdc);
1675 mpack_store_u16(p + 1, count);
1676}
1677
1678MPACK_STATIC_INLINE void mpack_encode_array32(char* p, uint32_t count) {
1679 mpack_assert(count > MPACK_UINT16_MAX);
1680 mpack_store_u8(p, 0xdd);
1681 mpack_store_u32(p + 1, count);
1682}
1683
1684MPACK_STATIC_INLINE void mpack_encode_fixmap(char* p, uint8_t count) {
1685 mpack_assert(count <= 15);
1686 mpack_store_u8(p, (uint8_t)(0x80 | count));
1687}
1688
1689MPACK_STATIC_INLINE void mpack_encode_map16(char* p, uint16_t count) {
1690 mpack_assert(count > 15);
1691 mpack_store_u8(p, 0xde);
1692 mpack_store_u16(p + 1, count);
1693}
1694
1695MPACK_STATIC_INLINE void mpack_encode_map32(char* p, uint32_t count) {
1696 mpack_assert(count > MPACK_UINT16_MAX);
1697 mpack_store_u8(p, 0xdf);
1698 mpack_store_u32(p + 1, count);
1699}
1700
1701MPACK_STATIC_INLINE void mpack_encode_fixstr(char* p, uint8_t count) {
1702 mpack_assert(count <= 31);
1703 mpack_store_u8(p, (uint8_t)(0xa0 | count));
1704}
1705
1706MPACK_STATIC_INLINE void mpack_encode_str8(char* p, uint8_t count) {
1707 mpack_assert(count > 31);
1708 mpack_store_u8(p, 0xd9);
1709 mpack_store_u8(p + 1, count);
1710}
1711
1712MPACK_STATIC_INLINE void mpack_encode_str16(char* p, uint16_t count) {
1713 // we might be encoding a raw in compatibility mode, so we
1714 // allow count to be in the range [32, MPACK_UINT8_MAX].
1715 mpack_assert(count > 31);
1716 mpack_store_u8(p, 0xda);
1717 mpack_store_u16(p + 1, count);
1718}
1719
1720MPACK_STATIC_INLINE void mpack_encode_str32(char* p, uint32_t count) {
1721 mpack_assert(count > MPACK_UINT16_MAX);
1722 mpack_store_u8(p, 0xdb);
1723 mpack_store_u32(p + 1, count);
1724}
1725
1726MPACK_STATIC_INLINE void mpack_encode_bin8(char* p, uint8_t count) {
1727 mpack_store_u8(p, 0xc4);
1728 mpack_store_u8(p + 1, count);
1729}
1730
1731MPACK_STATIC_INLINE void mpack_encode_bin16(char* p, uint16_t count) {
1732 mpack_assert(count > MPACK_UINT8_MAX);
1733 mpack_store_u8(p, 0xc5);
1734 mpack_store_u16(p + 1, count);
1735}
1736
1737MPACK_STATIC_INLINE void mpack_encode_bin32(char* p, uint32_t count) {
1738 mpack_assert(count > MPACK_UINT16_MAX);
1739 mpack_store_u8(p, 0xc6);
1740 mpack_store_u32(p + 1, count);
1741}
1742
1743#if MPACK_EXTENSIONS
1744MPACK_STATIC_INLINE void mpack_encode_fixext1(char* p, int8_t exttype) {
1745 mpack_store_u8(p, 0xd4);
1746 mpack_store_i8(p + 1, exttype);
1747}
1748
1749MPACK_STATIC_INLINE void mpack_encode_fixext2(char* p, int8_t exttype) {
1750 mpack_store_u8(p, 0xd5);
1751 mpack_store_i8(p + 1, exttype);
1752}
1753
1754MPACK_STATIC_INLINE void mpack_encode_fixext4(char* p, int8_t exttype) {
1755 mpack_store_u8(p, 0xd6);
1756 mpack_store_i8(p + 1, exttype);
1757}
1758
1759MPACK_STATIC_INLINE void mpack_encode_fixext8(char* p, int8_t exttype) {
1760 mpack_store_u8(p, 0xd7);
1761 mpack_store_i8(p + 1, exttype);
1762}
1763
1764MPACK_STATIC_INLINE void mpack_encode_fixext16(char* p, int8_t exttype) {
1765 mpack_store_u8(p, 0xd8);
1766 mpack_store_i8(p + 1, exttype);
1767}
1768
1769MPACK_STATIC_INLINE void mpack_encode_ext8(char* p, int8_t exttype, uint8_t count) {
1770 mpack_assert(count != 1 && count != 2 && count != 4 && count != 8 && count != 16);
1771 mpack_store_u8(p, 0xc7);
1772 mpack_store_u8(p + 1, count);
1773 mpack_store_i8(p + 2, exttype);
1774}
1775
1776MPACK_STATIC_INLINE void mpack_encode_ext16(char* p, int8_t exttype, uint16_t count) {
1777 mpack_assert(count > MPACK_UINT8_MAX);
1778 mpack_store_u8(p, 0xc8);
1779 mpack_store_u16(p + 1, count);
1780 mpack_store_i8(p + 3, exttype);
1781}
1782
1783MPACK_STATIC_INLINE void mpack_encode_ext32(char* p, int8_t exttype, uint32_t count) {
1784 mpack_assert(count > MPACK_UINT16_MAX);
1785 mpack_store_u8(p, 0xc9);
1786 mpack_store_u32(p + 1, count);
1787 mpack_store_i8(p + 5, exttype);
1788}
1789
1790MPACK_STATIC_INLINE void mpack_encode_timestamp_4(char* p, uint32_t seconds) {
1791 mpack_encode_fixext4(p, MPACK_EXTTYPE_TIMESTAMP);
1792 mpack_store_u32(p + MPACK_TAG_SIZE_FIXEXT4, seconds);
1793}
1794
1795MPACK_STATIC_INLINE void mpack_encode_timestamp_8(char* p, int64_t seconds, uint32_t nanoseconds) {
1796 mpack_assert(nanoseconds <= MPACK_TIMESTAMP_NANOSECONDS_MAX);
1797 mpack_encode_fixext8(p, MPACK_EXTTYPE_TIMESTAMP);
1798 uint64_t encoded = ((uint64_t)nanoseconds << 34) | (uint64_t)seconds;
1799 mpack_store_u64(p + MPACK_TAG_SIZE_FIXEXT8, encoded);
1800}
1801
1802MPACK_STATIC_INLINE void mpack_encode_timestamp_12(char* p, int64_t seconds, uint32_t nanoseconds) {
1803 mpack_assert(nanoseconds <= MPACK_TIMESTAMP_NANOSECONDS_MAX);
1804 mpack_encode_ext8(p, MPACK_EXTTYPE_TIMESTAMP, 12);
1805 mpack_store_u32(p + MPACK_TAG_SIZE_EXT8, nanoseconds);
1806 mpack_store_i64(p + MPACK_TAG_SIZE_EXT8 + 4, seconds);
1807}
1808#endif
1809
1810
1811
1812/*
1813 * Write functions
1814 */
1815
1816// This is a macro wrapper to the encode functions to encode
1817// directly into the buffer. If mpack_writer_ensure() fails
1818// it will flag an error so we don't have to do anything.
1819#define MPACK_WRITE_ENCODED(encode_fn, size, ...) do { \
1820 if (MPACK_LIKELY(mpack_writer_buffer_left(writer) >= size) || mpack_writer_ensure(writer, size)) { \
1821 MPACK_EXPAND(encode_fn(writer->position, __VA_ARGS__)); \
1822 writer->position += size; \
1823 } \
1824} while (0)
1825
1826void mpack_write_u8(mpack_writer_t* writer, uint8_t value) {
1827 #if MPACK_OPTIMIZE_FOR_SIZE
1828 mpack_write_u64(writer, value);
1829 #else
1830 mpack_writer_track_element(writer);
1831 if (value <= 127) {
1832 MPACK_WRITE_ENCODED(mpack_encode_fixuint, MPACK_TAG_SIZE_FIXUINT, value);
1833 } else {
1834 MPACK_WRITE_ENCODED(mpack_encode_u8, MPACK_TAG_SIZE_U8, value);
1835 }
1836 #endif
1837}
1838
1839void mpack_write_u16(mpack_writer_t* writer, uint16_t value) {
1840 #if MPACK_OPTIMIZE_FOR_SIZE
1841 mpack_write_u64(writer, value);
1842 #else
1843 mpack_writer_track_element(writer);
1844 if (value <= 127) {
1845 MPACK_WRITE_ENCODED(mpack_encode_fixuint, MPACK_TAG_SIZE_FIXUINT, (uint8_t)value);
1846 } else if (value <= MPACK_UINT8_MAX) {
1847 MPACK_WRITE_ENCODED(mpack_encode_u8, MPACK_TAG_SIZE_U8, (uint8_t)value);
1848 } else {
1849 MPACK_WRITE_ENCODED(mpack_encode_u16, MPACK_TAG_SIZE_U16, value);
1850 }
1851 #endif
1852}
1853
1854void mpack_write_u32(mpack_writer_t* writer, uint32_t value) {
1855 #if MPACK_OPTIMIZE_FOR_SIZE
1856 mpack_write_u64(writer, value);
1857 #else
1858 mpack_writer_track_element(writer);
1859 if (value <= 127) {
1860 MPACK_WRITE_ENCODED(mpack_encode_fixuint, MPACK_TAG_SIZE_FIXUINT, (uint8_t)value);
1861 } else if (value <= MPACK_UINT8_MAX) {
1862 MPACK_WRITE_ENCODED(mpack_encode_u8, MPACK_TAG_SIZE_U8, (uint8_t)value);
1863 } else if (value <= MPACK_UINT16_MAX) {
1864 MPACK_WRITE_ENCODED(mpack_encode_u16, MPACK_TAG_SIZE_U16, (uint16_t)value);
1865 } else {
1866 MPACK_WRITE_ENCODED(mpack_encode_u32, MPACK_TAG_SIZE_U32, value);
1867 }
1868 #endif
1869}
1870
1871void mpack_write_u64(mpack_writer_t* writer, uint64_t value) {
1872 mpack_writer_track_element(writer);
1873
1874 if (value <= 127) {
1875 MPACK_WRITE_ENCODED(mpack_encode_fixuint, MPACK_TAG_SIZE_FIXUINT, (uint8_t)value);
1876 } else if (value <= MPACK_UINT8_MAX) {
1877 MPACK_WRITE_ENCODED(mpack_encode_u8, MPACK_TAG_SIZE_U8, (uint8_t)value);
1878 } else if (value <= MPACK_UINT16_MAX) {
1879 MPACK_WRITE_ENCODED(mpack_encode_u16, MPACK_TAG_SIZE_U16, (uint16_t)value);
1880 } else if (value <= MPACK_UINT32_MAX) {
1881 MPACK_WRITE_ENCODED(mpack_encode_u32, MPACK_TAG_SIZE_U32, (uint32_t)value);
1882 } else {
1883 MPACK_WRITE_ENCODED(mpack_encode_u64, MPACK_TAG_SIZE_U64, value);
1884 }
1885}
1886
1887void mpack_write_i8(mpack_writer_t* writer, int8_t value) {
1888 #if MPACK_OPTIMIZE_FOR_SIZE
1889 mpack_write_i64(writer, value);
1890 #else
1891 mpack_writer_track_element(writer);
1892 if (value >= -32) {
1893 // we encode positive and negative fixints together
1894 MPACK_WRITE_ENCODED(mpack_encode_fixint, MPACK_TAG_SIZE_FIXINT, (int8_t)value);
1895 } else {
1896 MPACK_WRITE_ENCODED(mpack_encode_i8, MPACK_TAG_SIZE_I8, (int8_t)value);
1897 }
1898 #endif
1899}
1900
1901void mpack_write_i16(mpack_writer_t* writer, int16_t value) {
1902 #if MPACK_OPTIMIZE_FOR_SIZE
1903 mpack_write_i64(writer, value);
1904 #else
1905 mpack_writer_track_element(writer);
1906 if (value >= -32) {
1907 if (value <= 127) {
1908 // we encode positive and negative fixints together
1909 MPACK_WRITE_ENCODED(mpack_encode_fixint, MPACK_TAG_SIZE_FIXINT, (int8_t)value);
1910 } else if (value <= MPACK_UINT8_MAX) {
1911 MPACK_WRITE_ENCODED(mpack_encode_u8, MPACK_TAG_SIZE_U8, (uint8_t)value);
1912 } else {
1913 MPACK_WRITE_ENCODED(mpack_encode_u16, MPACK_TAG_SIZE_U16, (uint16_t)value);
1914 }
1915 } else if (value >= MPACK_INT8_MIN) {
1916 MPACK_WRITE_ENCODED(mpack_encode_i8, MPACK_TAG_SIZE_I8, (int8_t)value);
1917 } else {
1918 MPACK_WRITE_ENCODED(mpack_encode_i16, MPACK_TAG_SIZE_I16, (int16_t)value);
1919 }
1920 #endif
1921}
1922
1923void mpack_write_i32(mpack_writer_t* writer, int32_t value) {
1924 #if MPACK_OPTIMIZE_FOR_SIZE
1925 mpack_write_i64(writer, value);
1926 #else
1927 mpack_writer_track_element(writer);
1928 if (value >= -32) {
1929 if (value <= 127) {
1930 // we encode positive and negative fixints together
1931 MPACK_WRITE_ENCODED(mpack_encode_fixint, MPACK_TAG_SIZE_FIXINT, (int8_t)value);
1932 } else if (value <= MPACK_UINT8_MAX) {
1933 MPACK_WRITE_ENCODED(mpack_encode_u8, MPACK_TAG_SIZE_U8, (uint8_t)value);
1934 } else if (value <= MPACK_UINT16_MAX) {
1935 MPACK_WRITE_ENCODED(mpack_encode_u16, MPACK_TAG_SIZE_U16, (uint16_t)value);
1936 } else {
1937 MPACK_WRITE_ENCODED(mpack_encode_u32, MPACK_TAG_SIZE_U32, (uint32_t)value);
1938 }
1939 } else if (value >= MPACK_INT8_MIN) {
1940 MPACK_WRITE_ENCODED(mpack_encode_i8, MPACK_TAG_SIZE_I8, (int8_t)value);
1941 } else if (value >= MPACK_INT16_MIN) {
1942 MPACK_WRITE_ENCODED(mpack_encode_i16, MPACK_TAG_SIZE_I16, (int16_t)value);
1943 } else {
1944 MPACK_WRITE_ENCODED(mpack_encode_i32, MPACK_TAG_SIZE_I32, value);
1945 }
1946 #endif
1947}
1948
1949void mpack_write_i64(mpack_writer_t* writer, int64_t value) {
1950 #if MPACK_OPTIMIZE_FOR_SIZE
1951 if (value > 127) {
1952 // for non-fix positive ints we call the u64 writer to save space
1953 mpack_write_u64(writer, (uint64_t)value);
1954 return;
1955 }
1956 #endif
1957
1958 mpack_writer_track_element(writer);
1959 if (value >= -32) {
1960 #if MPACK_OPTIMIZE_FOR_SIZE
1961 MPACK_WRITE_ENCODED(mpack_encode_fixint, MPACK_TAG_SIZE_FIXINT, (int8_t)value);
1962 #else
1963 if (value <= 127) {
1964 MPACK_WRITE_ENCODED(mpack_encode_fixint, MPACK_TAG_SIZE_FIXINT, (int8_t)value);
1965 } else if (value <= MPACK_UINT8_MAX) {
1966 MPACK_WRITE_ENCODED(mpack_encode_u8, MPACK_TAG_SIZE_U8, (uint8_t)value);
1967 } else if (value <= MPACK_UINT16_MAX) {
1968 MPACK_WRITE_ENCODED(mpack_encode_u16, MPACK_TAG_SIZE_U16, (uint16_t)value);
1969 } else if (value <= MPACK_UINT32_MAX) {
1970 MPACK_WRITE_ENCODED(mpack_encode_u32, MPACK_TAG_SIZE_U32, (uint32_t)value);
1971 } else {
1972 MPACK_WRITE_ENCODED(mpack_encode_u64, MPACK_TAG_SIZE_U64, (uint64_t)value);
1973 }
1974 #endif
1975 } else if (value >= MPACK_INT8_MIN) {
1976 MPACK_WRITE_ENCODED(mpack_encode_i8, MPACK_TAG_SIZE_I8, (int8_t)value);
1977 } else if (value >= MPACK_INT16_MIN) {
1978 MPACK_WRITE_ENCODED(mpack_encode_i16, MPACK_TAG_SIZE_I16, (int16_t)value);
1979 } else if (value >= MPACK_INT32_MIN) {
1980 MPACK_WRITE_ENCODED(mpack_encode_i32, MPACK_TAG_SIZE_I32, (int32_t)value);
1981 } else {
1982 MPACK_WRITE_ENCODED(mpack_encode_i64, MPACK_TAG_SIZE_I64, value);
1983 }
1984}
1985
1986#if MPACK_FLOAT
1987void mpack_write_float(mpack_writer_t* writer, float value) {
1988 mpack_writer_track_element(writer);
1989 MPACK_WRITE_ENCODED(mpack_encode_float, MPACK_TAG_SIZE_FLOAT, value);
1990}
1991#else
1992void mpack_write_raw_float(mpack_writer_t* writer, uint32_t value) {
1993 mpack_writer_track_element(writer);
1994 MPACK_WRITE_ENCODED(mpack_encode_raw_float, MPACK_TAG_SIZE_FLOAT, value);
1995}
1996#endif
1997
1998#if MPACK_DOUBLE
1999void mpack_write_double(mpack_writer_t* writer, double value) {
2000 mpack_writer_track_element(writer);
2001 MPACK_WRITE_ENCODED(mpack_encode_double, MPACK_TAG_SIZE_DOUBLE, value);
2002}
2003#else
2004void mpack_write_raw_double(mpack_writer_t* writer, uint64_t value) {
2005 mpack_writer_track_element(writer);
2006 MPACK_WRITE_ENCODED(mpack_encode_raw_double, MPACK_TAG_SIZE_DOUBLE, value);
2007}
2008#endif
2009
2010#if MPACK_EXTENSIONS
2011void mpack_write_timestamp(mpack_writer_t* writer, int64_t seconds, uint32_t nanoseconds) {
2012 #if MPACK_COMPATIBILITY
2013 if (writer->version <= mpack_version_v4) {
2014 mpack_break("Timestamps require spec version v5 or later. This writer is in v%i mode.", (int)writer->version);
2015 mpack_writer_flag_error(writer, mpack_error_bug);
2016 return;
2017 }
2018 #endif
2019
2020 if (nanoseconds > MPACK_TIMESTAMP_NANOSECONDS_MAX) {
2021 mpack_break("timestamp nanoseconds out of bounds: %u", nanoseconds);
2022 mpack_writer_flag_error(writer, mpack_error_bug);
2023 return;
2024 }
2025
2026 mpack_writer_track_element(writer);
2027
2028 if (seconds < 0 || seconds >= (MPACK_INT64_C(1) << 34)) {
2029 MPACK_WRITE_ENCODED(mpack_encode_timestamp_12, MPACK_EXT_SIZE_TIMESTAMP12, seconds, nanoseconds);
2030 } else if (seconds > MPACK_UINT32_MAX || nanoseconds > 0) {
2031 MPACK_WRITE_ENCODED(mpack_encode_timestamp_8, MPACK_EXT_SIZE_TIMESTAMP8, seconds, nanoseconds);
2032 } else {
2033 MPACK_WRITE_ENCODED(mpack_encode_timestamp_4, MPACK_EXT_SIZE_TIMESTAMP4, (uint32_t)seconds);
2034 }
2035}
2036#endif
2037
2038static void mpack_write_array_notrack(mpack_writer_t* writer, uint32_t count) {
2039 if (count <= 15) {
2040 MPACK_WRITE_ENCODED(mpack_encode_fixarray, MPACK_TAG_SIZE_FIXARRAY, (uint8_t)count);
2041 } else if (count <= MPACK_UINT16_MAX) {
2042 MPACK_WRITE_ENCODED(mpack_encode_array16, MPACK_TAG_SIZE_ARRAY16, (uint16_t)count);
2043 } else {
2044 MPACK_WRITE_ENCODED(mpack_encode_array32, MPACK_TAG_SIZE_ARRAY32, (uint32_t)count);
2045 }
2046}
2047
2048static void mpack_write_map_notrack(mpack_writer_t* writer, uint32_t count) {
2049 if (count <= 15) {
2050 MPACK_WRITE_ENCODED(mpack_encode_fixmap, MPACK_TAG_SIZE_FIXMAP, (uint8_t)count);
2051 } else if (count <= MPACK_UINT16_MAX) {
2052 MPACK_WRITE_ENCODED(mpack_encode_map16, MPACK_TAG_SIZE_MAP16, (uint16_t)count);
2053 } else {
2054 MPACK_WRITE_ENCODED(mpack_encode_map32, MPACK_TAG_SIZE_MAP32, (uint32_t)count);
2055 }
2056}
2057
2058void mpack_start_array(mpack_writer_t* writer, uint32_t count) {
2059 mpack_writer_track_element(writer);
2060 mpack_write_array_notrack(writer, count);
2061 mpack_writer_track_push(writer, mpack_type_array, count);
2062 mpack_builder_compound_push(writer);
2063}
2064
2065void mpack_start_map(mpack_writer_t* writer, uint32_t count) {
2066 mpack_writer_track_element(writer);
2067 mpack_write_map_notrack(writer, count);
2068 mpack_writer_track_push(writer, mpack_type_map, count);
2069 mpack_builder_compound_push(writer);
2070}
2071
2072static void mpack_start_str_notrack(mpack_writer_t* writer, uint32_t count) {
2073 if (count <= 31) {
2074 MPACK_WRITE_ENCODED(mpack_encode_fixstr, MPACK_TAG_SIZE_FIXSTR, (uint8_t)count);
2075
2076 // str8 is only supported in v5 or later.
2077 } else if (count <= MPACK_UINT8_MAX
2078 #if MPACK_COMPATIBILITY
2079 && writer->version >= mpack_version_v5
2080 #endif
2081 ) {
2082 MPACK_WRITE_ENCODED(mpack_encode_str8, MPACK_TAG_SIZE_STR8, (uint8_t)count);
2083
2084 } else if (count <= MPACK_UINT16_MAX) {
2085 MPACK_WRITE_ENCODED(mpack_encode_str16, MPACK_TAG_SIZE_STR16, (uint16_t)count);
2086 } else {
2087 MPACK_WRITE_ENCODED(mpack_encode_str32, MPACK_TAG_SIZE_STR32, (uint32_t)count);
2088 }
2089}
2090
2091static void mpack_start_bin_notrack(mpack_writer_t* writer, uint32_t count) {
2092 #if MPACK_COMPATIBILITY
2093 // In the v4 spec, there was only the raw type for any kind of
2094 // variable-length data. In v4 mode, we support the bin functions,
2095 // but we produce an old-style raw.
2096 if (writer->version <= mpack_version_v4) {
2097 mpack_start_str_notrack(writer, count);
2098 return;
2099 }
2100 #endif
2101
2102 if (count <= MPACK_UINT8_MAX) {
2103 MPACK_WRITE_ENCODED(mpack_encode_bin8, MPACK_TAG_SIZE_BIN8, (uint8_t)count);
2104 } else if (count <= MPACK_UINT16_MAX) {
2105 MPACK_WRITE_ENCODED(mpack_encode_bin16, MPACK_TAG_SIZE_BIN16, (uint16_t)count);
2106 } else {
2107 MPACK_WRITE_ENCODED(mpack_encode_bin32, MPACK_TAG_SIZE_BIN32, (uint32_t)count);
2108 }
2109}
2110
2111void mpack_start_str(mpack_writer_t* writer, uint32_t count) {
2112 mpack_writer_track_element(writer);
2113 mpack_start_str_notrack(writer, count);
2114 mpack_writer_track_push(writer, mpack_type_str, count);
2115}
2116
2117void mpack_start_bin(mpack_writer_t* writer, uint32_t count) {
2118 mpack_writer_track_element(writer);
2119 mpack_start_bin_notrack(writer, count);
2120 mpack_writer_track_push(writer, mpack_type_bin, count);
2121}
2122
2123#if MPACK_EXTENSIONS
2124void mpack_start_ext(mpack_writer_t* writer, int8_t exttype, uint32_t count) {
2125 #if MPACK_COMPATIBILITY
2126 if (writer->version <= mpack_version_v4) {
2127 mpack_break("Ext types require spec version v5 or later. This writer is in v%i mode.", (int)writer->version);
2128 mpack_writer_flag_error(writer, mpack_error_bug);
2129 return;
2130 }
2131 #endif
2132
2133 mpack_writer_track_element(writer);
2134
2135 if (count == 1) {
2136 MPACK_WRITE_ENCODED(mpack_encode_fixext1, MPACK_TAG_SIZE_FIXEXT1, exttype);
2137 } else if (count == 2) {
2138 MPACK_WRITE_ENCODED(mpack_encode_fixext2, MPACK_TAG_SIZE_FIXEXT2, exttype);
2139 } else if (count == 4) {
2140 MPACK_WRITE_ENCODED(mpack_encode_fixext4, MPACK_TAG_SIZE_FIXEXT4, exttype);
2141 } else if (count == 8) {
2142 MPACK_WRITE_ENCODED(mpack_encode_fixext8, MPACK_TAG_SIZE_FIXEXT8, exttype);
2143 } else if (count == 16) {
2144 MPACK_WRITE_ENCODED(mpack_encode_fixext16, MPACK_TAG_SIZE_FIXEXT16, exttype);
2145 } else if (count <= MPACK_UINT8_MAX) {
2146 MPACK_WRITE_ENCODED(mpack_encode_ext8, MPACK_TAG_SIZE_EXT8, exttype, (uint8_t)count);
2147 } else if (count <= MPACK_UINT16_MAX) {
2148 MPACK_WRITE_ENCODED(mpack_encode_ext16, MPACK_TAG_SIZE_EXT16, exttype, (uint16_t)count);
2149 } else {
2150 MPACK_WRITE_ENCODED(mpack_encode_ext32, MPACK_TAG_SIZE_EXT32, exttype, (uint32_t)count);
2151 }
2152
2153 mpack_writer_track_push(writer, mpack_type_ext, count);
2154}
2155#endif
2156
2157
2158
2159/*
2160 * Compound helpers and other functions
2161 */
2162
2163void mpack_write_str(mpack_writer_t* writer, const char* data, uint32_t count) {
2164 mpack_assert(data != NULL, "data for string of length %i is NULL", (int)count);
2165
2166 #if MPACK_OPTIMIZE_FOR_SIZE
2167 mpack_writer_track_element(writer);
2168 mpack_start_str_notrack(writer, count);
2169 mpack_write_native(writer, data, count);
2170 #else
2171
2172 mpack_writer_track_element(writer);
2173
2174 if (count <= 31) {
2175 // The minimum buffer size when using a flush function is guaranteed to
2176 // fit the largest possible fixstr.
2177 size_t size = count + MPACK_TAG_SIZE_FIXSTR;
2178 if (MPACK_LIKELY(mpack_writer_buffer_left(writer) >= size) || mpack_writer_ensure(writer, size)) {
2179 char* MPACK_RESTRICT p = writer->position;
2180 mpack_encode_fixstr(p, (uint8_t)count);
2181 mpack_memcpy(p + MPACK_TAG_SIZE_FIXSTR, data, count);
2182 writer->position += count + MPACK_TAG_SIZE_FIXSTR;
2183 }
2184 return;
2185 }
2186
2187 if (count <= MPACK_UINT8_MAX
2188 #if MPACK_COMPATIBILITY
2189 && writer->version >= mpack_version_v5
2190 #endif
2191 ) {
2192 if (count + MPACK_TAG_SIZE_STR8 <= mpack_writer_buffer_left(writer)) {
2193 char* MPACK_RESTRICT p = writer->position;
2194 mpack_encode_str8(p, (uint8_t)count);
2195 mpack_memcpy(p + MPACK_TAG_SIZE_STR8, data, count);
2196 writer->position += count + MPACK_TAG_SIZE_STR8;
2197 } else {
2198 MPACK_WRITE_ENCODED(mpack_encode_str8, MPACK_TAG_SIZE_STR8, (uint8_t)count);
2199 mpack_write_native(writer, data, count);
2200 }
2201 return;
2202 }
2203
2204 // str16 and str32 are likely to be a significant fraction of the buffer
2205 // size, so we don't bother with a combined space check in order to
2206 // minimize code size.
2207 if (count <= MPACK_UINT16_MAX) {
2208 MPACK_WRITE_ENCODED(mpack_encode_str16, MPACK_TAG_SIZE_STR16, (uint16_t)count);
2209 mpack_write_native(writer, data, count);
2210 } else {
2211 MPACK_WRITE_ENCODED(mpack_encode_str32, MPACK_TAG_SIZE_STR32, (uint32_t)count);
2212 mpack_write_native(writer, data, count);
2213 }
2214
2215 #endif
2216}
2217
2218void mpack_write_bin(mpack_writer_t* writer, const char* data, uint32_t count) {
2219 mpack_assert(data != NULL, "data pointer for bin of %i bytes is NULL", (int)count);
2220 mpack_start_bin(writer, count);
2221 mpack_write_bytes(writer, data, count);
2222 mpack_finish_bin(writer);
2223}
2224
2225#if MPACK_EXTENSIONS
2226void mpack_write_ext(mpack_writer_t* writer, int8_t exttype, const char* data, uint32_t count) {
2227 mpack_assert(data != NULL, "data pointer for ext of type %i and %i bytes is NULL", exttype, (int)count);
2228 mpack_start_ext(writer, exttype, count);
2229 mpack_write_bytes(writer, data, count);
2230 mpack_finish_ext(writer);
2231}
2232#endif
2233
2234void mpack_write_bytes(mpack_writer_t* writer, const char* data, size_t count) {
2235 mpack_assert(data != NULL, "data pointer for %i bytes is NULL", (int)count);
2236 mpack_writer_track_bytes(writer, count);
2237 mpack_write_native(writer, data, count);
2238}
2239
2240void mpack_write_cstr(mpack_writer_t* writer, const char* cstr) {
2241 mpack_assert(cstr != NULL, "cstr pointer is NULL");
2242 size_t length = mpack_strlen(cstr);
2243 if (length > MPACK_UINT32_MAX)
2244 mpack_writer_flag_error(writer, mpack_error_invalid);
2245 mpack_write_str(writer, cstr, (uint32_t)length);
2246}
2247
2248void mpack_write_cstr_or_nil(mpack_writer_t* writer, const char* cstr) {
2249 if (cstr)
2250 mpack_write_cstr(writer, cstr);
2251 else
2252 mpack_write_nil(writer);
2253}
2254
2255void mpack_write_utf8(mpack_writer_t* writer, const char* str, uint32_t length) {
2256 mpack_assert(str != NULL, "data for string of length %i is NULL", (int)length);
2257 if (!mpack_utf8_check(str, length)) {
2258 mpack_writer_flag_error(writer, mpack_error_invalid);
2259 return;
2260 }
2261 mpack_write_str(writer, str, length);
2262}
2263
2264void mpack_write_utf8_cstr(mpack_writer_t* writer, const char* cstr) {
2265 mpack_assert(cstr != NULL, "cstr pointer is NULL");
2266 size_t length = mpack_strlen(cstr);
2267 if (length > MPACK_UINT32_MAX) {
2268 mpack_writer_flag_error(writer, mpack_error_invalid);
2269 return;
2270 }
2271 mpack_write_utf8(writer, cstr, (uint32_t)length);
2272}
2273
2274void mpack_write_utf8_cstr_or_nil(mpack_writer_t* writer, const char* cstr) {
2275 if (cstr)
2276 mpack_write_utf8_cstr(writer, cstr);
2277 else
2278 mpack_write_nil(writer);
2279}
2280
2281/*
2282 * Builder implementation
2283 *
2284 * When a writer is in build mode, it diverts writes to an internal growable
2285 * buffer. All elements other than builder start tags are encoded as normal
2286 * into the builder buffer (even nested maps and arrays of known size, e.g.
2287 * `mpack_start_array()`.) But for compound elements of unknown size, an
2288 * mpack_build_t is written to the buffer instead.
2289 *
2290 * The mpack_build_t tracks everything needed to re-constitute the final
2291 * message once all sizes are known. When the last build element is completed,
2292 * the builder resolves the build by walking through the builds, outputting the
2293 * final encoded tag, and copying everything in between to the writer's true
2294 * buffer.
2295 *
2296 * To make things extra complicated, the builder buffer is not contiguous. It's
2297 * allocated in pages, where the first page may be an internal page in the
2298 * writer. But, each mpack_build_t must itself be contiguous and aligned
2299 * properly within the buffer. This means bytes can be skipped (and wasted)
2300 * before the builds or at the end of pages.
2301 *
2302 * To keep track of this, builds store both their element count and the number
2303 * of encoded bytes that follow, and pages store the number of bytes used. As
2304 * elements are written, each element adds to the count in the current open
2305 * build, and the number of bytes written adds to the current page and the byte
2306 * count in the last started build (whether or not it is completed.)
2307 */
2308
2309#if MPACK_BUILDER
2310
2311#ifdef MPACK_ALIGNOF
2312 #define MPACK_BUILD_ALIGNMENT MPACK_ALIGNOF(mpack_build_t)
2313#else
2314 // without alignof, we just align to the greater of size_t, void* and uint64_t.
2315 // (we do this even though we don't have uint64_t in it in case we add it later.)
2316 #define MPACK_BUILD_ALIGNMENT_MAX(x, y) ((x) > (y) ? (x) : (y))
2317 #define MPACK_BUILD_ALIGNMENT (MPACK_BUILD_ALIGNMENT_MAX(sizeof(void*), \
2318 MPACK_BUILD_ALIGNMENT_MAX(sizeof(size_t), sizeof(uint64_t))))
2319#endif
2320
2321static inline void mpack_builder_check_sizes(mpack_writer_t* writer) {
2322
2323 // We check internal and page sizes here so that we don't have to check
2324 // them again. A new page with a build in it will have a page header,
2325 // build, and minimum space for a tag. This will perform horribly and waste
2326 // tons of memory if the page size is small, so you're best off just
2327 // sticking with the defaults.
2328 //
2329 // These are all known at compile time, so if they are large
2330 // enough this function should trivially optimize to a no-op.
2331
2332 #if MPACK_BUILDER_INTERNAL_STORAGE
2333 // make sure the internal storage is big enough to be useful
2334 MPACK_STATIC_ASSERT(MPACK_BUILDER_INTERNAL_STORAGE_SIZE >= (sizeof(mpack_builder_page_t) +
2335 sizeof(mpack_build_t) + MPACK_WRITER_MINIMUM_BUFFER_SIZE),
2336 "MPACK_BUILDER_INTERNAL_STORAGE_SIZE is too small to be useful!");
2337 if (MPACK_BUILDER_INTERNAL_STORAGE_SIZE < (sizeof(mpack_builder_page_t) +
2338 sizeof(mpack_build_t) + MPACK_WRITER_MINIMUM_BUFFER_SIZE))
2339 {
2340 mpack_break("MPACK_BUILDER_INTERNAL_STORAGE_SIZE is too small to be useful!");
2341 mpack_writer_flag_error(writer, mpack_error_bug);
2342 }
2343 #endif
2344
2345 // make sure the builder page size is big enough to be useful
2346 MPACK_STATIC_ASSERT(MPACK_BUILDER_PAGE_SIZE >= (sizeof(mpack_builder_page_t) +
2347 sizeof(mpack_build_t) + MPACK_WRITER_MINIMUM_BUFFER_SIZE),
2348 "MPACK_BUILDER_PAGE_SIZE is too small to be useful!");
2349 if (MPACK_BUILDER_PAGE_SIZE < (sizeof(mpack_builder_page_t) +
2350 sizeof(mpack_build_t) + MPACK_WRITER_MINIMUM_BUFFER_SIZE))
2351 {
2352 mpack_break("MPACK_BUILDER_PAGE_SIZE is too small to be useful!");
2353 mpack_writer_flag_error(writer, mpack_error_bug);
2354 }
2355}
2356
2357static inline size_t mpack_builder_page_size(mpack_writer_t* writer, mpack_builder_page_t* page) {
2358 #if MPACK_BUILDER_INTERNAL_STORAGE
2359 if ((char*)page == writer->builder.internal)
2360 return sizeof(writer->builder.internal);
2361 #else
2362 (void)writer;
2363 (void)page;
2364 #endif
2365 return MPACK_BUILDER_PAGE_SIZE;
2366}
2367
2368static inline size_t mpack_builder_align_build(size_t bytes_used) {
2369 size_t offset = bytes_used;
2370 offset += MPACK_BUILD_ALIGNMENT - 1;
2371 offset -= offset % MPACK_BUILD_ALIGNMENT;
2372 mpack_log("aligned %zi to %zi\n", bytes_used, offset);
2373 return offset;
2374}
2375
2376static inline void mpack_builder_free_page(mpack_writer_t* writer, mpack_builder_page_t* page) {
2377 mpack_log("freeing page %p\n", (void*)page);
2378 #if MPACK_BUILDER_INTERNAL_STORAGE
2379 if ((char*)page == writer->builder.internal)
2380 return;
2381 #else
2382 (void)writer;
2383 #endif
2384 MPACK_FREE(page);
2385}
2386
2387static inline size_t mpack_builder_page_remaining(mpack_writer_t* writer, mpack_builder_page_t* page) {
2388 return mpack_builder_page_size(writer, page) - page->bytes_used;
2389}
2390
2391static void mpack_builder_configure_buffer(mpack_writer_t* writer) {
2392 if (mpack_writer_error(writer) != mpack_ok)
2393 return;
2394 mpack_builder_t* builder = &writer->builder;
2395
2396 mpack_builder_page_t* page = builder->current_page;
2397 mpack_assert(page != NULL, "page is null??");
2398
2399 // This diverts the writer into the remainder of the current page of our
2400 // build buffer.
2401 writer->buffer = (char*)page + page->bytes_used;
2402 writer->position = (char*)page + page->bytes_used;
2403 writer->end = (char*)page + mpack_builder_page_size(writer, page);
2404 mpack_log("configuring buffer from %p to %p\n", (void*)writer->position, (void*)writer->end);
2405}
2406
2407static void mpack_builder_add_page(mpack_writer_t* writer) {
2408 mpack_builder_t* builder = &writer->builder;
2409 mpack_assert(writer->error == mpack_ok);
2410
2411 mpack_log("adding a page.\n");
2412 mpack_builder_page_t* page = (mpack_builder_page_t*)MPACK_MALLOC(MPACK_BUILDER_PAGE_SIZE);
2413 if (page == NULL) {
2414 mpack_writer_flag_error(writer, mpack_error_memory);
2415 return;
2416 }
2417
2418 page->next = NULL;
2419 page->bytes_used = sizeof(mpack_builder_page_t);
2420 builder->current_page->next = page;
2421 builder->current_page = page;
2422}
2423
2424// Checks how many bytes the writer wrote to the page, adding it to the page's
2425// bytes_used. This must be followed up with mpack_builder_configure_buffer()
2426// (after adding a new page, build, etc) to reset the writer's buffer pointers.
2427static void mpack_builder_apply_writes(mpack_writer_t* writer) {
2428 mpack_assert(writer->error == mpack_ok);
2429 mpack_builder_t* builder = &writer->builder;
2430 mpack_log("latest build is %p\n", (void*)builder->latest_build);
2431
2432 // The difference between buffer and current is the number of bytes that
2433 // were written to the page.
2434 size_t bytes_written = (size_t)(writer->position - writer->buffer);
2435 mpack_log("applying write of %zi bytes to build %p\n", bytes_written, (void*)builder->latest_build);
2436
2437 mpack_assert(builder->current_page != NULL);
2438 mpack_assert(builder->latest_build != NULL);
2439 builder->current_page->bytes_used += bytes_written;
2440 builder->latest_build->bytes += bytes_written;
2441 mpack_log("latest build %p now has %zi bytes\n", (void*)builder->latest_build, builder->latest_build->bytes);
2442}
2443
2444static void mpack_builder_flush(mpack_writer_t* writer) {
2445 mpack_assert(writer->error == mpack_ok);
2446 mpack_builder_apply_writes(writer);
2447 mpack_builder_add_page(writer);
2448 mpack_builder_configure_buffer(writer);
2449}
2450
2451MPACK_NOINLINE static void mpack_builder_begin(mpack_writer_t* writer) {
2452 mpack_builder_t* builder = &writer->builder;
2453 mpack_assert(writer->error == mpack_ok);
2454 mpack_assert(builder->current_build == NULL);
2455 mpack_assert(builder->latest_build == NULL);
2456 mpack_assert(builder->pages == NULL);
2457
2458 // If this is the first build, we need to stash the real buffer backing our
2459 // writer. We'll be diverting the writer to our build buffer.
2460 builder->stash_buffer = writer->buffer;
2461 builder->stash_position = writer->position;
2462 builder->stash_end = writer->end;
2463
2464 mpack_builder_page_t* page;
2465
2466 // we've checked that both these sizes are large enough above.
2467 #if MPACK_BUILDER_INTERNAL_STORAGE
2468 page = (mpack_builder_page_t*)builder->internal;
2469 mpack_log("beginning builder with internal storage %p\n", (void*)page);
2470 #else
2471 page = (mpack_builder_page_t*)MPACK_MALLOC(MPACK_BUILDER_PAGE_SIZE);
2472 if (page == NULL) {
2473 mpack_writer_flag_error(writer, mpack_error_memory);
2474 return;
2475 }
2476 mpack_log("beginning builder with allocated page %p\n", (void*)page);
2477 #endif
2478
2479 page->next = NULL;
2480 page->bytes_used = sizeof(mpack_builder_page_t);
2481 builder->pages = page;
2482 builder->current_page = page;
2483}
2484
2485static void mpack_builder_build(mpack_writer_t* writer, mpack_type_t type) {
2486 mpack_builder_check_sizes(writer);
2487 if (mpack_writer_error(writer) != mpack_ok)
2488 return;
2489
2490 mpack_writer_track_element(writer);
2491 mpack_writer_track_push_builder(writer, type);
2492
2493 mpack_builder_t* builder = &writer->builder;
2494
2495 if (builder->current_build == NULL) {
2496 mpack_builder_begin(writer);
2497 } else {
2498 mpack_builder_apply_writes(writer);
2499 }
2500 if (mpack_writer_error(writer) != mpack_ok)
2501 return;
2502
2503 // find aligned space for a new build. if there isn't enough space in the
2504 // current page, we discard the remaining space in it and allocate a new
2505 // page.
2506 size_t offset = mpack_builder_align_build(builder->current_page->bytes_used);
2507 if (offset + sizeof(mpack_build_t) > mpack_builder_page_size(writer, builder->current_page)) {
2508 mpack_log("not enough space for a build. %zi bytes used of %zi in this page\n",
2509 builder->current_page->bytes_used, mpack_builder_page_size(writer, builder->current_page));
2510 mpack_builder_add_page(writer);
2511 // there is always enough space in a fresh page.
2512 offset = mpack_builder_align_build(builder->current_page->bytes_used);
2513 }
2514
2515 // allocate the build within the page. note that we don't keep track of the
2516 // space wasted due to the offset. instead the previous build has stored
2517 // how many bytes follow it, and we'll redo this offset calculation to find
2518 // this build after it.
2519 mpack_builder_page_t* page = builder->current_page;
2520 page->bytes_used = offset + sizeof(mpack_build_t);
2521 mpack_assert(page->bytes_used <= mpack_builder_page_size(writer, page));
2522 mpack_build_t* build = (mpack_build_t*)((char*)page + offset);
2523 mpack_log("created new build %p within page %p, which now has %zi bytes used\n",
2524 (void*)build, (void*)page, page->bytes_used);
2525
2526 // configure the new build
2527 build->parent = builder->current_build;
2528 build->bytes = 0;
2529 build->count = 0;
2530 build->type = type;
2531 build->key_needs_value = false;
2532 build->nested_compound_elements = 0;
2533
2534 mpack_log("setting current and latest build to new build %p\n", (void*)build);
2535 builder->current_build = build;
2536 builder->latest_build = build;
2537
2538 // we always need to provide a buffer that meets the minimum buffer size.
2539 // if there isn't enough space, we discard the remaining space in the
2540 // current page and allocate a new one.
2541 if (mpack_builder_page_remaining(writer, page) < MPACK_WRITER_MINIMUM_BUFFER_SIZE) {
2542 mpack_log("less than minimum buffer size in current page. %zi bytes used of %zi in this page\n",
2543 builder->current_page->bytes_used, mpack_builder_page_size(writer, builder->current_page));
2544 mpack_builder_add_page(writer);
2545 if (mpack_writer_error(writer) != mpack_ok)
2546 return;
2547 }
2548 mpack_assert(mpack_builder_page_remaining(writer, builder->current_page) >= MPACK_WRITER_MINIMUM_BUFFER_SIZE);
2549 mpack_builder_configure_buffer(writer);
2550}
2551
2552MPACK_NOINLINE
2553static void mpack_builder_resolve(mpack_writer_t* writer) {
2554 mpack_builder_t* builder = &writer->builder;
2555
2556 // The starting page is the internal storage (if we have it), otherwise
2557 // it's the first page in the array
2558 mpack_builder_page_t* page =
2559 #if MPACK_BUILDER_INTERNAL_STORAGE
2560 (mpack_builder_page_t*)builder->internal
2561 #else
2562 builder->pages
2563 #endif
2564 ;
2565
2566 // We start by restoring the writer's original buffer so we can write the
2567 // data for real.
2568 writer->buffer = builder->stash_buffer;
2569 writer->position = builder->stash_position;
2570 writer->end = builder->stash_end;
2571
2572 // We can also close out the build now.
2573 builder->current_build = NULL;
2574 builder->latest_build = NULL;
2575 builder->current_page = NULL;
2576 builder->pages = NULL;
2577
2578 // the starting page always starts with the first build
2579 size_t offset = mpack_builder_align_build(sizeof(mpack_builder_page_t));
2580 mpack_build_t* build = (mpack_build_t*)((char*)page + offset);
2581 mpack_log("starting resolve with build %p in page %p\n", (void*)build, (void*)page);
2582
2583 // encoded data immediately follows the build
2584 offset += sizeof(mpack_build_t);
2585
2586 // Walk the list of builds, writing everything out in the buffer. Note that
2587 // we don't check for errors anywhere. The lower-level write functions will
2588 // all check for errors. We need to walk all pages anyway to free them, so
2589 // there's not much point in optimizing an error path at the expense of the
2590 // normal path.
2591 while (true) {
2592
2593 // write out the container tag
2594 mpack_log("writing out an %s with count %u followed by %zi bytes\n",
2595 mpack_type_to_string(build->type), build->count, build->bytes);
2596 switch (build->type) {
2597 case mpack_type_map:
2598 mpack_write_map_notrack(writer, build->count);
2599 break;
2600 case mpack_type_array:
2601 mpack_write_array_notrack(writer, build->count);
2602 break;
2603 default:
2604 mpack_break("invalid type in builder?");
2605 mpack_writer_flag_error(writer, mpack_error_bug);
2606 return;
2607 }
2608
2609 // figure out how many bytes follow this container. we're going to be
2610 // freeing pages as we write, so we need to be done with this build.
2611 size_t left = build->bytes;
2612 build = NULL;
2613
2614 // write out all bytes following this container
2615 while (left > 0) {
2616 size_t bytes_used = page->bytes_used;
2617 if (offset < bytes_used) {
2618 size_t step = bytes_used - offset;
2619 if (step > left)
2620 step = left;
2621 mpack_log("writing out %zi bytes starting at %p in page %p\n",
2622 step, (void*)((char*)page + offset), (void*)page);
2623 mpack_write_native(writer, (char*)page + offset, step);
2624 offset += step;
2625 left -= step;
2626 }
2627
2628 if (left == 0) {
2629 mpack_log("done writing bytes for this build\n");
2630 break;
2631 }
2632
2633 // still need to write more bytes. free this page and jump to the
2634 // next one.
2635 mpack_builder_page_t* next_page = page->next;
2636 mpack_builder_free_page(writer, page);
2637 page = next_page;
2638 // bytes on the next page immediately follow the header.
2639 offset = sizeof(mpack_builder_page_t);
2640 }
2641
2642 // now see if we can find another build.
2643 offset = mpack_builder_align_build(offset);
2644 if (offset + sizeof(mpack_build_t) >= mpack_builder_page_size(writer, page)) {
2645 mpack_log("not enough room in this page for another build\n");
2646 mpack_builder_page_t* next_page = page->next;
2647 mpack_builder_free_page(writer, page);
2648 page = next_page;
2649 if (page == NULL) {
2650 mpack_log("no more pages\n");
2651 // there are no more pages. we're done.
2652 break;
2653 }
2654 offset = mpack_builder_align_build(sizeof(mpack_builder_page_t));
2655 }
2656 if (offset + sizeof(mpack_build_t) > page->bytes_used) {
2657 // there is no more data. we're done.
2658 mpack_log("no more data\n");
2659 mpack_builder_free_page(writer, page);
2660 break;
2661 }
2662
2663 // we've found another build. loop around!
2664 build = (mpack_build_t*)((char*)page + offset);
2665 offset += sizeof(mpack_build_t);
2666 mpack_log("found build %p\n", (void*)build);
2667 }
2668
2669 mpack_log("done resolve.\n");
2670}
2671
2672static void mpack_builder_complete(mpack_writer_t* writer, mpack_type_t type) {
2673 if (mpack_writer_error(writer) != mpack_ok)
2674 return;
2675
2676 mpack_writer_track_pop_builder(writer, type);
2677 mpack_builder_t* builder = &writer->builder;
2678 mpack_assert(builder->current_build != NULL, "no build in progress!");
2679 mpack_assert(builder->latest_build != NULL, "missing latest build!");
2680 mpack_assert(builder->current_build->type == type, "completing wrong type!");
2681 mpack_log("completing build %p\n", (void*)builder->current_build);
2682
2683 if (builder->current_build->key_needs_value) {
2684 mpack_break("an odd number of elements were written in a map!");
2685 mpack_writer_flag_error(writer, mpack_error_bug);
2686 return;
2687 }
2688
2689 if (builder->current_build->nested_compound_elements != 0) {
2690 mpack_break("there is a nested unfinished non-build map or array in this build.");
2691 mpack_writer_flag_error(writer, mpack_error_bug);
2692 return;
2693 }
2694
2695 // We need to apply whatever writes have been made to the current build
2696 // before popping it.
2697 mpack_builder_apply_writes(writer);
2698
2699 // For a nested build, we just switch the current build back to its parent.
2700 if (builder->current_build->parent != NULL) {
2701 mpack_log("setting current build to parent build %p. latest is still %p.\n",
2702 (void*)builder->current_build->parent, (void*)builder->latest_build);
2703 builder->current_build = builder->current_build->parent;
2704 mpack_builder_configure_buffer(writer);
2705 } else {
2706 // We're completing the final build.
2707 mpack_builder_resolve(writer);
2708 }
2709}
2710
2711void mpack_build_map(mpack_writer_t* writer) {
2712 mpack_builder_build(writer, mpack_type_map);
2713}
2714
2715void mpack_build_array(mpack_writer_t* writer) {
2716 mpack_builder_build(writer, mpack_type_array);
2717}
2718
2719void mpack_complete_map(mpack_writer_t* writer) {
2720 mpack_builder_complete(writer, mpack_type_map);
2721}
2722
2723void mpack_complete_array(mpack_writer_t* writer) {
2724 mpack_builder_complete(writer, mpack_type_array);
2725}
2726
2727#endif // MPACK_BUILDER
2728#endif // MPACK_WRITER
2729
2730MPACK_SILENCE_WARNINGS_END
2731
2732/* mpack/mpack-reader.c.c */
2733
2734#define MPACK_INTERNAL 1
2735
2736/* #include "mpack-reader.h" */
2737
2738MPACK_SILENCE_WARNINGS_BEGIN
2739
2740#if MPACK_READER
2741
2742static void mpack_reader_skip_using_fill(mpack_reader_t* reader, size_t count);
2743
2744void mpack_reader_init(mpack_reader_t* reader, char* buffer, size_t size, size_t count) {
2745 mpack_assert(buffer != NULL, "buffer is NULL");
2746
2747 mpack_memset(reader, 0, sizeof(*reader));
2748 reader->buffer = buffer;
2749 reader->size = size;
2750 reader->data = buffer;
2751 reader->end = buffer + count;
2752
2753 #if MPACK_READ_TRACKING
2754 mpack_reader_flag_if_error(reader, mpack_track_init(&reader->track));
2755 #endif
2756
2757 mpack_log("===========================\n");
2758 mpack_log("initializing reader with buffer size %i\n", (int)size);
2759}
2760
2761void mpack_reader_init_error(mpack_reader_t* reader, mpack_error_t error) {
2762 mpack_memset(reader, 0, sizeof(*reader));
2763 reader->error = error;
2764
2765 mpack_log("===========================\n");
2766 mpack_log("initializing reader error state %i\n", (int)error);
2767}
2768
2769void mpack_reader_init_data(mpack_reader_t* reader, const char* data, size_t count) {
2770 mpack_assert(data != NULL, "data is NULL");
2771
2772 mpack_memset(reader, 0, sizeof(*reader));
2773 reader->data = data;
2774 reader->end = data + count;
2775
2776 #if MPACK_READ_TRACKING
2777 mpack_reader_flag_if_error(reader, mpack_track_init(&reader->track));
2778 #endif
2779
2780 mpack_log("===========================\n");
2781 mpack_log("initializing reader with data size %i\n", (int)count);
2782}
2783
2784void mpack_reader_set_fill(mpack_reader_t* reader, mpack_reader_fill_t fill) {
2785 MPACK_STATIC_ASSERT(MPACK_READER_MINIMUM_BUFFER_SIZE >= MPACK_MAXIMUM_TAG_SIZE,
2786 "minimum buffer size must fit any tag!");
2787
2788 if (reader->size == 0) {
2789 mpack_break("cannot use fill function without a writeable buffer!");
2790 mpack_reader_flag_error(reader, mpack_error_bug);
2791 return;
2792 }
2793
2794 if (reader->size < MPACK_READER_MINIMUM_BUFFER_SIZE) {
2795 mpack_break("buffer size is %i, but minimum buffer size for fill is %i",
2796 (int)reader->size, MPACK_READER_MINIMUM_BUFFER_SIZE);
2797 mpack_reader_flag_error(reader, mpack_error_bug);
2798 return;
2799 }
2800
2801 reader->fill = fill;
2802}
2803
2804void mpack_reader_set_skip(mpack_reader_t* reader, mpack_reader_skip_t skip) {
2805 mpack_assert(reader->size != 0, "cannot use skip function without a writeable buffer!");
2806 reader->skip = skip;
2807}
2808
2809#if MPACK_STDIO
2810static size_t mpack_file_reader_fill(mpack_reader_t* reader, char* buffer, size_t count) {
2811 if (feof((FILE *)reader->context)) {
2812 mpack_reader_flag_error(reader, mpack_error_eof);
2813 return 0;
2814 }
2815 return fread((void*)buffer, 1, count, (FILE*)reader->context);
2816}
2817
2818static void mpack_file_reader_skip(mpack_reader_t* reader, size_t count) {
2819 if (mpack_reader_error(reader) != mpack_ok)
2820 return;
2821 FILE* file = (FILE*)reader->context;
2822
2823 // We call ftell() to test whether the stream is seekable
2824 // without causing a file error.
2825 if (ftell(file) >= 0) {
2826 mpack_log("seeking forward %i bytes\n", (int)count);
2827 if (fseek(file, (long int)count, SEEK_CUR) == 0)
2828 return;
2829 mpack_log("fseek() didn't return zero!\n");
2830 if (ferror(file)) {
2831 mpack_reader_flag_error(reader, mpack_error_io);
2832 return;
2833 }
2834 }
2835
2836 // If the stream is not seekable, fall back to the fill function.
2837 mpack_reader_skip_using_fill(reader, count);
2838}
2839
2840static void mpack_file_reader_teardown(mpack_reader_t* reader) {
2841 MPACK_FREE(reader->buffer);
2842 reader->buffer = NULL;
2843 reader->context = NULL;
2844 reader->size = 0;
2845 reader->fill = NULL;
2846 reader->skip = NULL;
2847 reader->teardown = NULL;
2848}
2849
2850static void mpack_file_reader_teardown_close(mpack_reader_t* reader) {
2851 FILE* file = (FILE*)reader->context;
2852
2853 if (file) {
2854 int ret = fclose(file);
2855 if (ret != 0)
2856 mpack_reader_flag_error(reader, mpack_error_io);
2857 }
2858
2859 mpack_file_reader_teardown(reader);
2860}
2861
2862void mpack_reader_init_stdfile(mpack_reader_t* reader, FILE* file, bool close_when_done) {
2863 mpack_assert(file != NULL, "file is NULL");
2864
2865 size_t capacity = MPACK_BUFFER_SIZE;
2866 char* buffer = (char*)MPACK_MALLOC(capacity);
2867 if (buffer == NULL) {
2868 mpack_reader_init_error(reader, mpack_error_memory);
2869 if (close_when_done) {
2870 fclose(file);
2871 }
2872 return;
2873 }
2874
2875 mpack_reader_init(reader, buffer, capacity, 0);
2876 mpack_reader_set_context(reader, file);
2877 mpack_reader_set_fill(reader, mpack_file_reader_fill);
2878 mpack_reader_set_skip(reader, mpack_file_reader_skip);
2879 mpack_reader_set_teardown(reader, close_when_done ?
2880 mpack_file_reader_teardown_close :
2881 mpack_file_reader_teardown);
2882}
2883
2884void mpack_reader_init_filename(mpack_reader_t* reader, const char* filename) {
2885 mpack_assert(filename != NULL, "filename is NULL");
2886
2887 FILE* file = fopen(filename, "rb");
2888 if (file == NULL) {
2889 mpack_reader_init_error(reader, mpack_error_io);
2890 return;
2891 }
2892
2893 mpack_reader_init_stdfile(reader, file, true);
2894}
2895#endif
2896
2897mpack_error_t mpack_reader_destroy(mpack_reader_t* reader) {
2898
2899 // clean up tracking, asserting if we're not already in an error state
2900 #if MPACK_READ_TRACKING
2901 mpack_reader_flag_if_error(reader, mpack_track_destroy(&reader->track, mpack_reader_error(reader) != mpack_ok));
2902 #endif
2903
2904 if (reader->teardown)
2905 reader->teardown(reader);
2906 reader->teardown = NULL;
2907
2908 return reader->error;
2909}
2910
2911size_t mpack_reader_remaining(mpack_reader_t* reader, const char** data) {
2912 if (mpack_reader_error(reader) != mpack_ok)
2913 return 0;
2914
2915 #if MPACK_READ_TRACKING
2916 if (mpack_reader_flag_if_error(reader, mpack_track_check_empty(&reader->track)) != mpack_ok)
2917 return 0;
2918 #endif
2919
2920 if (data)
2921 *data = reader->data;
2922 return (size_t)(reader->end - reader->data);
2923}
2924
2925void mpack_reader_flag_error(mpack_reader_t* reader, mpack_error_t error) {
2926 mpack_log("reader %p setting error %i: %s\n", (void*)reader, (int)error, mpack_error_to_string(error));
2927
2928 if (reader->error == mpack_ok) {
2929 reader->error = error;
2930 reader->end = reader->data;
2931 if (reader->error_fn)
2932 reader->error_fn(reader, error);
2933 }
2934}
2935
2936// Loops on the fill function, reading between the minimum and
2937// maximum number of bytes and flagging an error if it fails.
2938MPACK_NOINLINE static size_t mpack_fill_range(mpack_reader_t* reader, char* p, size_t min_bytes, size_t max_bytes) {
2939 mpack_assert(reader->fill != NULL, "mpack_fill_range() called with no fill function?");
2940 mpack_assert(min_bytes > 0, "cannot fill zero bytes!");
2941 mpack_assert(max_bytes >= min_bytes, "min_bytes %i cannot be larger than max_bytes %i!",
2942 (int)min_bytes, (int)max_bytes);
2943
2944 size_t count = 0;
2945 while (count < min_bytes) {
2946 size_t read = reader->fill(reader, p + count, max_bytes - count);
2947
2948 // Reader fill functions can flag an error or return 0 on failure. We
2949 // also guard against functions that return -1 just in case.
2950 if (mpack_reader_error(reader) != mpack_ok)
2951 return 0;
2952 if (read == 0 || read == ((size_t)(-1))) {
2953 mpack_reader_flag_error(reader, mpack_error_io);
2954 return 0;
2955 }
2956
2957 count += read;
2958 }
2959 return count;
2960}
2961
2962MPACK_NOINLINE bool mpack_reader_ensure_straddle(mpack_reader_t* reader, size_t count) {
2963 mpack_assert(count != 0, "cannot ensure zero bytes!");
2964 mpack_assert(reader->error == mpack_ok, "reader cannot be in an error state!");
2965
2966 mpack_assert(count > (size_t)(reader->end - reader->data),
2967 "straddling ensure requested for %i bytes, but there are %i bytes "
2968 "left in buffer. call mpack_reader_ensure() instead",
2969 (int)count, (int)(reader->end - reader->data));
2970
2971 // we'll need a fill function to get more data. if there's no
2972 // fill function, the buffer should contain an entire MessagePack
2973 // object, so we raise mpack_error_invalid instead of mpack_error_io
2974 // on truncated data.
2975 if (reader->fill == NULL) {
2976 mpack_reader_flag_error(reader, mpack_error_invalid);
2977 return false;
2978 }
2979
2980 // we need enough space in the buffer. if the buffer is not
2981 // big enough, we return mpack_error_too_big (since this is
2982 // for an in-place read larger than the buffer size.)
2983 if (count > reader->size) {
2984 mpack_reader_flag_error(reader, mpack_error_too_big);
2985 return false;
2986 }
2987
2988 // move the existing data to the start of the buffer
2989 size_t left = (size_t)(reader->end - reader->data);
2990 mpack_memmove(reader->buffer, reader->data, left);
2991 reader->end -= reader->data - reader->buffer;
2992 reader->data = reader->buffer;
2993
2994 // read at least the necessary number of bytes, accepting up to the
2995 // buffer size
2996 size_t read = mpack_fill_range(reader, reader->buffer + left,
2997 count - left, reader->size - left);
2998 if (mpack_reader_error(reader) != mpack_ok)
2999 return false;
3000 reader->end += read;
3001 return true;
3002}
3003
3004// Reads count bytes into p. Used when there are not enough bytes
3005// left in the buffer to satisfy a read.
3006MPACK_NOINLINE void mpack_read_native_straddle(mpack_reader_t* reader, char* p, size_t count) {
3007 mpack_assert(count == 0 || p != NULL, "data pointer for %i bytes is NULL", (int)count);
3008
3009 if (mpack_reader_error(reader) != mpack_ok) {
3010 mpack_memset(p, 0, count);
3011 return;
3012 }
3013
3014 size_t left = (size_t)(reader->end - reader->data);
3015 mpack_log("big read for %i bytes into %p, %i left in buffer, buffer size %i\n",
3016 (int)count, p, (int)left, (int)reader->size);
3017
3018 if (count <= left) {
3019 mpack_assert(0,
3020 "big read requested for %i bytes, but there are %i bytes "
3021 "left in buffer. call mpack_read_native() instead",
3022 (int)count, (int)left);
3023 mpack_reader_flag_error(reader, mpack_error_bug);
3024 mpack_memset(p, 0, count);
3025 return;
3026 }
3027
3028 // we'll need a fill function to get more data. if there's no
3029 // fill function, the buffer should contain an entire MessagePack
3030 // object, so we raise mpack_error_invalid instead of mpack_error_io
3031 // on truncated data.
3032 if (reader->fill == NULL) {
3033 mpack_reader_flag_error(reader, mpack_error_invalid);
3034 mpack_memset(p, 0, count);
3035 return;
3036 }
3037
3038 if (reader->size == 0) {
3039 // somewhat debatable what error should be returned here. when
3040 // initializing a reader with an in-memory buffer it's not
3041 // necessarily a bug if the data is blank; it might just have
3042 // been truncated to zero. for this reason we return the same
3043 // error as if the data was truncated.
3044 mpack_reader_flag_error(reader, mpack_error_io);
3045 mpack_memset(p, 0, count);
3046 return;
3047 }
3048
3049 // flush what's left of the buffer
3050 if (left > 0) {
3051 mpack_log("flushing %i bytes remaining in buffer\n", (int)left);
3052 mpack_memcpy(p, reader->data, left);
3053 count -= left;
3054 p += left;
3055 reader->data += left;
3056 }
3057
3058 // if the remaining data needed is some small fraction of the
3059 // buffer size, we'll try to fill the buffer as much as possible
3060 // and copy the needed data out.
3061 if (count <= reader->size / MPACK_READER_SMALL_FRACTION_DENOMINATOR) {
3062 size_t read = mpack_fill_range(reader, reader->buffer, count, reader->size);
3063 if (mpack_reader_error(reader) != mpack_ok)
3064 return;
3065 mpack_memcpy(p, reader->buffer, count);
3066 reader->data = reader->buffer + count;
3067 reader->end = reader->buffer + read;
3068
3069 // otherwise we read the remaining data directly into the target.
3070 } else {
3071 mpack_log("reading %i additional bytes\n", (int)count);
3072 mpack_fill_range(reader, p, count, count);
3073 }
3074}
3075
3076MPACK_NOINLINE static void mpack_skip_bytes_straddle(mpack_reader_t* reader, size_t count) {
3077
3078 // we'll need at least a fill function to skip more data. if there's
3079 // no fill function, the buffer should contain an entire MessagePack
3080 // object, so we raise mpack_error_invalid instead of mpack_error_io
3081 // on truncated data. (see mpack_read_native_straddle())
3082 if (reader->fill == NULL) {
3083 mpack_log("reader has no fill function!\n");
3084 mpack_reader_flag_error(reader, mpack_error_invalid);
3085 return;
3086 }
3087
3088 // discard whatever's left in the buffer
3089 size_t left = (size_t)(reader->end - reader->data);
3090 mpack_log("discarding %i bytes still in buffer\n", (int)left);
3091 count -= left;
3092 reader->data = reader->end;
3093
3094 // use the skip function if we've got one, and if we're trying
3095 // to skip a lot of data. if we only need to skip some tiny
3096 // fraction of the buffer size, it's probably better to just
3097 // fill the buffer and skip from it instead of trying to seek.
3098 if (reader->skip && count > reader->size / 16) {
3099 mpack_log("calling skip function for %i bytes\n", (int)count);
3100 reader->skip(reader, count);
3101 return;
3102 }
3103
3104 mpack_reader_skip_using_fill(reader, count);
3105}
3106
3107void mpack_skip_bytes(mpack_reader_t* reader, size_t count) {
3108 if (mpack_reader_error(reader) != mpack_ok)
3109 return;
3110 mpack_log("skip requested for %i bytes\n", (int)count);
3111
3112 mpack_reader_track_bytes(reader, count);
3113
3114 // check if we have enough in the buffer already
3115 size_t left = (size_t)(reader->end - reader->data);
3116 if (left >= count) {
3117 mpack_log("skipping %u bytes still in buffer\n", (uint32_t)count);
3118 reader->data += count;
3119 return;
3120 }
3121
3122 mpack_skip_bytes_straddle(reader, count);
3123}
3124
3125MPACK_NOINLINE static void mpack_reader_skip_using_fill(mpack_reader_t* reader, size_t count) {
3126 mpack_assert(reader->fill != NULL, "missing fill function!");
3127 mpack_assert(reader->data == reader->end, "there are bytes left in the buffer!");
3128 mpack_assert(reader->error == mpack_ok, "should not have called this in an error state (%i)", reader->error);
3129 mpack_log("skip using fill for %i bytes\n", (int)count);
3130
3131 // fill and discard multiples of the buffer size
3132 while (count > reader->size) {
3133 mpack_log("filling and discarding buffer of %i bytes\n", (int)reader->size);
3134 if (mpack_fill_range(reader, reader->buffer, reader->size, reader->size) < reader->size) {
3135 mpack_reader_flag_error(reader, mpack_error_io);
3136 return;
3137 }
3138 count -= reader->size;
3139 }
3140
3141 // fill the buffer as much as possible
3142 reader->data = reader->buffer;
3143 size_t read = mpack_fill_range(reader, reader->buffer, count, reader->size);
3144 if (read < count) {
3145 mpack_reader_flag_error(reader, mpack_error_io);
3146 return;
3147 }
3148 reader->end = reader->data + read;
3149 mpack_log("filled %i bytes into buffer; discarding %i bytes\n", (int)read, (int)count);
3150 reader->data += count;
3151}
3152
3153void mpack_read_bytes(mpack_reader_t* reader, char* p, size_t count) {
3154 mpack_assert(p != NULL, "destination for read of %i bytes is NULL", (int)count);
3155 mpack_reader_track_bytes(reader, count);
3156 mpack_read_native(reader, p, count);
3157}
3158
3159void mpack_read_utf8(mpack_reader_t* reader, char* p, size_t byte_count) {
3160 mpack_assert(p != NULL, "destination for read of %i bytes is NULL", (int)byte_count);
3161 mpack_reader_track_str_bytes_all(reader, byte_count);
3162 mpack_read_native(reader, p, byte_count);
3163
3164 if (mpack_reader_error(reader) == mpack_ok && !mpack_utf8_check(p, byte_count))
3165 mpack_reader_flag_error(reader, mpack_error_type);
3166}
3167
3168static void mpack_read_cstr_unchecked(mpack_reader_t* reader, char* buf, size_t buffer_size, size_t byte_count) {
3169 mpack_assert(buf != NULL, "destination for read of %i bytes is NULL", (int)byte_count);
3170 mpack_assert(buffer_size >= 1, "buffer size is zero; you must have room for at least a null-terminator");
3171
3172 if (mpack_reader_error(reader)) {
3173 buf[0] = 0;
3174 return;
3175 }
3176
3177 if (byte_count > buffer_size - 1) {
3178 mpack_reader_flag_error(reader, mpack_error_too_big);
3179 buf[0] = 0;
3180 return;
3181 }
3182
3183 mpack_reader_track_str_bytes_all(reader, byte_count);
3184 mpack_read_native(reader, buf, byte_count);
3185 buf[byte_count] = 0;
3186}
3187
3188void mpack_read_cstr(mpack_reader_t* reader, char* buf, size_t buffer_size, size_t byte_count) {
3189 mpack_read_cstr_unchecked(reader, buf, buffer_size, byte_count);
3190
3191 // check for null bytes
3192 if (mpack_reader_error(reader) == mpack_ok && !mpack_str_check_no_null(buf, byte_count)) {
3193 buf[0] = 0;
3194 mpack_reader_flag_error(reader, mpack_error_type);
3195 }
3196}
3197
3198void mpack_read_utf8_cstr(mpack_reader_t* reader, char* buf, size_t buffer_size, size_t byte_count) {
3199 mpack_read_cstr_unchecked(reader, buf, buffer_size, byte_count);
3200
3201 // check encoding
3202 if (mpack_reader_error(reader) == mpack_ok && !mpack_utf8_check_no_null(buf, byte_count)) {
3203 buf[0] = 0;
3204 mpack_reader_flag_error(reader, mpack_error_type);
3205 }
3206}
3207
3208#ifdef MPACK_MALLOC
3209// Reads native bytes with error callback disabled. This allows MPack reader functions
3210// to hold an allocated buffer and read native data into it without leaking it in
3211// case of a non-local jump (longjmp, throw) out of an error handler.
3212static void mpack_read_native_noerrorfn(mpack_reader_t* reader, char* p, size_t count) {
3213 mpack_assert(reader->error == mpack_ok, "cannot call if an error is already flagged!");
3214 mpack_reader_error_t error_fn = reader->error_fn;
3215 reader->error_fn = NULL;
3216 mpack_read_native(reader, p, count);
3217 reader->error_fn = error_fn;
3218}
3219
3220char* mpack_read_bytes_alloc_impl(mpack_reader_t* reader, size_t count, bool null_terminated) {
3221
3222 // track the bytes first in case it jumps
3223 mpack_reader_track_bytes(reader, count);
3224 if (mpack_reader_error(reader) != mpack_ok)
3225 return NULL;
3226
3227 // cannot allocate zero bytes. this is not an error.
3228 if (count == 0 && null_terminated == false)
3229 return NULL;
3230
3231 // allocate data
3232 char* data = (char*)MPACK_MALLOC(count + (null_terminated ? 1 : 0)); // TODO: can this overflow?
3233 if (data == NULL) {
3234 mpack_reader_flag_error(reader, mpack_error_memory);
3235 return NULL;
3236 }
3237
3238 // read with error callback disabled so we don't leak our buffer
3239 mpack_read_native_noerrorfn(reader, data, count);
3240
3241 // report flagged errors
3242 if (mpack_reader_error(reader) != mpack_ok) {
3243 MPACK_FREE(data);
3244 if (reader->error_fn)
3245 reader->error_fn(reader, mpack_reader_error(reader));
3246 return NULL;
3247 }
3248
3249 if (null_terminated)
3250 data[count] = '\0';
3251 return data;
3252}
3253#endif
3254
3255// read inplace without tracking (since there are different
3256// tracking modes for different inplace readers)
3257static const char* mpack_read_bytes_inplace_notrack(mpack_reader_t* reader, size_t count) {
3258 if (mpack_reader_error(reader) != mpack_ok)
3259 return NULL;
3260
3261 // if we have enough bytes already in the buffer, we can return it directly.
3262 if ((size_t)(reader->end - reader->data) >= count) {
3263 const char* bytes = reader->data;
3264 reader->data += count;
3265 return bytes;
3266 }
3267
3268 if (!mpack_reader_ensure(reader, count))
3269 return NULL;
3270
3271 const char* bytes = reader->data;
3272 reader->data += count;
3273 return bytes;
3274}
3275
3276const char* mpack_read_bytes_inplace(mpack_reader_t* reader, size_t count) {
3277 mpack_reader_track_bytes(reader, count);
3278 return mpack_read_bytes_inplace_notrack(reader, count);
3279}
3280
3281const char* mpack_read_utf8_inplace(mpack_reader_t* reader, size_t count) {
3282 mpack_reader_track_str_bytes_all(reader, count);
3283 const char* str = mpack_read_bytes_inplace_notrack(reader, count);
3284
3285 if (mpack_reader_error(reader) == mpack_ok && !mpack_utf8_check(str, count)) {
3286 mpack_reader_flag_error(reader, mpack_error_type);
3287 return NULL;
3288 }
3289
3290 return str;
3291}
3292
3293static size_t mpack_parse_tag(mpack_reader_t* reader, mpack_tag_t* tag) {
3294 mpack_assert(reader->error == mpack_ok, "reader cannot be in an error state!");
3295
3296 if (!mpack_reader_ensure(reader, 1))
3297 return 0;
3298 uint8_t type = mpack_load_u8(reader->data);
3299
3300 // unfortunately, by far the fastest way to parse a tag is to switch
3301 // on the first byte, and to explicitly list every possible byte. so for
3302 // infix types, the list of cases is quite large.
3303 //
3304 // in size-optimized builds, we switch on the top four bits first to
3305 // handle most infix types with a smaller jump table to save space.
3306
3307 #if MPACK_OPTIMIZE_FOR_SIZE
3308 switch (type >> 4) {
3309
3310 // positive fixnum
3311 case 0x0: case 0x1: case 0x2: case 0x3:
3312 case 0x4: case 0x5: case 0x6: case 0x7:
3313 *tag = mpack_tag_make_uint(type);
3314 return 1;
3315
3316 // negative fixnum
3317 case 0xe: case 0xf:
3318 *tag = mpack_tag_make_int((int8_t)type);
3319 return 1;
3320
3321 // fixmap
3322 case 0x8:
3323 *tag = mpack_tag_make_map(type & ~0xf0u);
3324 return 1;
3325
3326 // fixarray
3327 case 0x9:
3328 *tag = mpack_tag_make_array(type & ~0xf0u);
3329 return 1;
3330
3331 // fixstr
3332 case 0xa: case 0xb:
3333 *tag = mpack_tag_make_str(type & ~0xe0u);
3334 return 1;
3335
3336 // not one of the common infix types
3337 default:
3338 break;
3339
3340 }
3341 #endif
3342
3343 // handle individual type tags
3344 switch (type) {
3345
3346 #if !MPACK_OPTIMIZE_FOR_SIZE
3347 // positive fixnum
3348 case 0x00: case 0x01: case 0x02: case 0x03: case 0x04: case 0x05: case 0x06: case 0x07:
3349 case 0x08: case 0x09: case 0x0a: case 0x0b: case 0x0c: case 0x0d: case 0x0e: case 0x0f:
3350 case 0x10: case 0x11: case 0x12: case 0x13: case 0x14: case 0x15: case 0x16: case 0x17:
3351 case 0x18: case 0x19: case 0x1a: case 0x1b: case 0x1c: case 0x1d: case 0x1e: case 0x1f:
3352 case 0x20: case 0x21: case 0x22: case 0x23: case 0x24: case 0x25: case 0x26: case 0x27:
3353 case 0x28: case 0x29: case 0x2a: case 0x2b: case 0x2c: case 0x2d: case 0x2e: case 0x2f:
3354 case 0x30: case 0x31: case 0x32: case 0x33: case 0x34: case 0x35: case 0x36: case 0x37:
3355 case 0x38: case 0x39: case 0x3a: case 0x3b: case 0x3c: case 0x3d: case 0x3e: case 0x3f:
3356 case 0x40: case 0x41: case 0x42: case 0x43: case 0x44: case 0x45: case 0x46: case 0x47:
3357 case 0x48: case 0x49: case 0x4a: case 0x4b: case 0x4c: case 0x4d: case 0x4e: case 0x4f:
3358 case 0x50: case 0x51: case 0x52: case 0x53: case 0x54: case 0x55: case 0x56: case 0x57:
3359 case 0x58: case 0x59: case 0x5a: case 0x5b: case 0x5c: case 0x5d: case 0x5e: case 0x5f:
3360 case 0x60: case 0x61: case 0x62: case 0x63: case 0x64: case 0x65: case 0x66: case 0x67:
3361 case 0x68: case 0x69: case 0x6a: case 0x6b: case 0x6c: case 0x6d: case 0x6e: case 0x6f:
3362 case 0x70: case 0x71: case 0x72: case 0x73: case 0x74: case 0x75: case 0x76: case 0x77:
3363 case 0x78: case 0x79: case 0x7a: case 0x7b: case 0x7c: case 0x7d: case 0x7e: case 0x7f:
3364 *tag = mpack_tag_make_uint(type);
3365 return 1;
3366
3367 // negative fixnum
3368 case 0xe0: case 0xe1: case 0xe2: case 0xe3: case 0xe4: case 0xe5: case 0xe6: case 0xe7:
3369 case 0xe8: case 0xe9: case 0xea: case 0xeb: case 0xec: case 0xed: case 0xee: case 0xef:
3370 case 0xf0: case 0xf1: case 0xf2: case 0xf3: case 0xf4: case 0xf5: case 0xf6: case 0xf7:
3371 case 0xf8: case 0xf9: case 0xfa: case 0xfb: case 0xfc: case 0xfd: case 0xfe: case 0xff:
3372 *tag = mpack_tag_make_int((int8_t)type);
3373 return 1;
3374
3375 // fixmap
3376 case 0x80: case 0x81: case 0x82: case 0x83: case 0x84: case 0x85: case 0x86: case 0x87:
3377 case 0x88: case 0x89: case 0x8a: case 0x8b: case 0x8c: case 0x8d: case 0x8e: case 0x8f:
3378 *tag = mpack_tag_make_map(type & ~0xf0u);
3379 return 1;
3380
3381 // fixarray
3382 case 0x90: case 0x91: case 0x92: case 0x93: case 0x94: case 0x95: case 0x96: case 0x97:
3383 case 0x98: case 0x99: case 0x9a: case 0x9b: case 0x9c: case 0x9d: case 0x9e: case 0x9f:
3384 *tag = mpack_tag_make_array(type & ~0xf0u);
3385 return 1;
3386
3387 // fixstr
3388 case 0xa0: case 0xa1: case 0xa2: case 0xa3: case 0xa4: case 0xa5: case 0xa6: case 0xa7:
3389 case 0xa8: case 0xa9: case 0xaa: case 0xab: case 0xac: case 0xad: case 0xae: case 0xaf:
3390 case 0xb0: case 0xb1: case 0xb2: case 0xb3: case 0xb4: case 0xb5: case 0xb6: case 0xb7:
3391 case 0xb8: case 0xb9: case 0xba: case 0xbb: case 0xbc: case 0xbd: case 0xbe: case 0xbf:
3392 *tag = mpack_tag_make_str(type & ~0xe0u);
3393 return 1;
3394 #endif
3395
3396 // nil
3397 case 0xc0:
3398 *tag = mpack_tag_make_nil();
3399 return 1;
3400
3401 // bool
3402 case 0xc2: case 0xc3:
3403 *tag = mpack_tag_make_bool((bool)(type & 1));
3404 return 1;
3405
3406 // bin8
3407 case 0xc4:
3408 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_BIN8))
3409 return 0;
3410 *tag = mpack_tag_make_bin(mpack_load_u8(reader->data + 1));
3411 return MPACK_TAG_SIZE_BIN8;
3412
3413 // bin16
3414 case 0xc5:
3415 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_BIN16))
3416 return 0;
3417 *tag = mpack_tag_make_bin(mpack_load_u16(reader->data + 1));
3418 return MPACK_TAG_SIZE_BIN16;
3419
3420 // bin32
3421 case 0xc6:
3422 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_BIN32))
3423 return 0;
3424 *tag = mpack_tag_make_bin(mpack_load_u32(reader->data + 1));
3425 return MPACK_TAG_SIZE_BIN32;
3426
3427 #if MPACK_EXTENSIONS
3428 // ext8
3429 case 0xc7:
3430 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_EXT8))
3431 return 0;
3432 *tag = mpack_tag_make_ext(mpack_load_i8(reader->data + 2), mpack_load_u8(reader->data + 1));
3433 return MPACK_TAG_SIZE_EXT8;
3434
3435 // ext16
3436 case 0xc8:
3437 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_EXT16))
3438 return 0;
3439 *tag = mpack_tag_make_ext(mpack_load_i8(reader->data + 3), mpack_load_u16(reader->data + 1));
3440 return MPACK_TAG_SIZE_EXT16;
3441
3442 // ext32
3443 case 0xc9:
3444 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_EXT32))
3445 return 0;
3446 *tag = mpack_tag_make_ext(mpack_load_i8(reader->data + 5), mpack_load_u32(reader->data + 1));
3447 return MPACK_TAG_SIZE_EXT32;
3448 #endif
3449
3450 // float
3451 case 0xca:
3452 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_FLOAT))
3453 return 0;
3454 #if MPACK_FLOAT
3455 *tag = mpack_tag_make_float(mpack_load_float(reader->data + 1));
3456 #else
3457 *tag = mpack_tag_make_raw_float(mpack_load_u32(reader->data + 1));
3458 #endif
3459 return MPACK_TAG_SIZE_FLOAT;
3460
3461 // double
3462 case 0xcb:
3463 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_DOUBLE))
3464 return 0;
3465 #if MPACK_DOUBLE
3466 *tag = mpack_tag_make_double(mpack_load_double(reader->data + 1));
3467 #else
3468 *tag = mpack_tag_make_raw_double(mpack_load_u64(reader->data + 1));
3469 #endif
3470 return MPACK_TAG_SIZE_DOUBLE;
3471
3472 // uint8
3473 case 0xcc:
3474 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_U8))
3475 return 0;
3476 *tag = mpack_tag_make_uint(mpack_load_u8(reader->data + 1));
3477 return MPACK_TAG_SIZE_U8;
3478
3479 // uint16
3480 case 0xcd:
3481 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_U16))
3482 return 0;
3483 *tag = mpack_tag_make_uint(mpack_load_u16(reader->data + 1));
3484 return MPACK_TAG_SIZE_U16;
3485
3486 // uint32
3487 case 0xce:
3488 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_U32))
3489 return 0;
3490 *tag = mpack_tag_make_uint(mpack_load_u32(reader->data + 1));
3491 return MPACK_TAG_SIZE_U32;
3492
3493 // uint64
3494 case 0xcf:
3495 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_U64))
3496 return 0;
3497 *tag = mpack_tag_make_uint(mpack_load_u64(reader->data + 1));
3498 return MPACK_TAG_SIZE_U64;
3499
3500 // int8
3501 case 0xd0:
3502 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_I8))
3503 return 0;
3504 *tag = mpack_tag_make_int(mpack_load_i8(reader->data + 1));
3505 return MPACK_TAG_SIZE_I8;
3506
3507 // int16
3508 case 0xd1:
3509 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_I16))
3510 return 0;
3511 *tag = mpack_tag_make_int(mpack_load_i16(reader->data + 1));
3512 return MPACK_TAG_SIZE_I16;
3513
3514 // int32
3515 case 0xd2:
3516 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_I32))
3517 return 0;
3518 *tag = mpack_tag_make_int(mpack_load_i32(reader->data + 1));
3519 return MPACK_TAG_SIZE_I32;
3520
3521 // int64
3522 case 0xd3:
3523 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_I64))
3524 return 0;
3525 *tag = mpack_tag_make_int(mpack_load_i64(reader->data + 1));
3526 return MPACK_TAG_SIZE_I64;
3527
3528 #if MPACK_EXTENSIONS
3529 // fixext1
3530 case 0xd4:
3531 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_FIXEXT1))
3532 return 0;
3533 *tag = mpack_tag_make_ext(mpack_load_i8(reader->data + 1), 1);
3534 return MPACK_TAG_SIZE_FIXEXT1;
3535
3536 // fixext2
3537 case 0xd5:
3538 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_FIXEXT2))
3539 return 0;
3540 *tag = mpack_tag_make_ext(mpack_load_i8(reader->data + 1), 2);
3541 return MPACK_TAG_SIZE_FIXEXT2;
3542
3543 // fixext4
3544 case 0xd6:
3545 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_FIXEXT4))
3546 return 0;
3547 *tag = mpack_tag_make_ext(mpack_load_i8(reader->data + 1), 4);
3548 return 2;
3549
3550 // fixext8
3551 case 0xd7:
3552 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_FIXEXT8))
3553 return 0;
3554 *tag = mpack_tag_make_ext(mpack_load_i8(reader->data + 1), 8);
3555 return MPACK_TAG_SIZE_FIXEXT8;
3556
3557 // fixext16
3558 case 0xd8:
3559 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_FIXEXT16))
3560 return 0;
3561 *tag = mpack_tag_make_ext(mpack_load_i8(reader->data + 1), 16);
3562 return MPACK_TAG_SIZE_FIXEXT16;
3563 #endif
3564
3565 // str8
3566 case 0xd9:
3567 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_STR8))
3568 return 0;
3569 *tag = mpack_tag_make_str(mpack_load_u8(reader->data + 1));
3570 return MPACK_TAG_SIZE_STR8;
3571
3572 // str16
3573 case 0xda:
3574 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_STR16))
3575 return 0;
3576 *tag = mpack_tag_make_str(mpack_load_u16(reader->data + 1));
3577 return MPACK_TAG_SIZE_STR16;
3578
3579 // str32
3580 case 0xdb:
3581 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_STR32))
3582 return 0;
3583 *tag = mpack_tag_make_str(mpack_load_u32(reader->data + 1));
3584 return MPACK_TAG_SIZE_STR32;
3585
3586 // array16
3587 case 0xdc:
3588 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_ARRAY16))
3589 return 0;
3590 *tag = mpack_tag_make_array(mpack_load_u16(reader->data + 1));
3591 return MPACK_TAG_SIZE_ARRAY16;
3592
3593 // array32
3594 case 0xdd:
3595 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_ARRAY32))
3596 return 0;
3597 *tag = mpack_tag_make_array(mpack_load_u32(reader->data + 1));
3598 return MPACK_TAG_SIZE_ARRAY32;
3599
3600 // map16
3601 case 0xde:
3602 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_MAP16))
3603 return 0;
3604 *tag = mpack_tag_make_map(mpack_load_u16(reader->data + 1));
3605 return MPACK_TAG_SIZE_MAP16;
3606
3607 // map32
3608 case 0xdf:
3609 if (!mpack_reader_ensure(reader, MPACK_TAG_SIZE_MAP32))
3610 return 0;
3611 *tag = mpack_tag_make_map(mpack_load_u32(reader->data + 1));
3612 return MPACK_TAG_SIZE_MAP32;
3613
3614 // reserved
3615 case 0xc1:
3616 mpack_reader_flag_error(reader, mpack_error_invalid);
3617 return 0;
3618
3619 #if !MPACK_EXTENSIONS
3620 // ext
3621 case 0xc7: // fallthrough
3622 case 0xc8: // fallthrough
3623 case 0xc9: // fallthrough
3624 // fixext
3625 case 0xd4: // fallthrough
3626 case 0xd5: // fallthrough
3627 case 0xd6: // fallthrough
3628 case 0xd7: // fallthrough
3629 case 0xd8:
3630 mpack_reader_flag_error(reader, mpack_error_unsupported);
3631 return 0;
3632 #endif
3633
3634 #if MPACK_OPTIMIZE_FOR_SIZE
3635 // any other bytes should have been handled by the infix switch
3636 default:
3637 break;
3638 #endif
3639 }
3640
3641 mpack_assert(0, "unreachable");
3642 return 0;
3643}
3644
3645mpack_tag_t mpack_read_tag(mpack_reader_t* reader) {
3646 mpack_log("reading tag\n");
3647
3648 // make sure we can read a tag
3649 if (mpack_reader_error(reader) != mpack_ok)
3650 return mpack_tag_nil();
3651 if (mpack_reader_track_element(reader) != mpack_ok)
3652 return mpack_tag_nil();
3653
3654 mpack_tag_t tag = MPACK_TAG_ZERO;
3655 size_t count = mpack_parse_tag(reader, &tag);
3656 if (count == 0)
3657 return mpack_tag_nil();
3658
3659 #if MPACK_READ_TRACKING
3660 mpack_error_t track_error = mpack_ok;
3661
3662 switch (tag.type) {
3663 case mpack_type_map:
3664 case mpack_type_array:
3665 track_error = mpack_track_push(&reader->track, tag.type, tag.v.n);
3666 break;
3667 #if MPACK_EXTENSIONS
3668 case mpack_type_ext:
3669 #endif
3670 case mpack_type_str:
3671 case mpack_type_bin:
3672 track_error = mpack_track_push(&reader->track, tag.type, tag.v.l);
3673 break;
3674 default:
3675 break;
3676 }
3677
3678 if (track_error != mpack_ok) {
3679 mpack_reader_flag_error(reader, track_error);
3680 return mpack_tag_nil();
3681 }
3682 #endif
3683
3684 reader->data += count;
3685 return tag;
3686}
3687
3688mpack_tag_t mpack_peek_tag(mpack_reader_t* reader) {
3689 mpack_log("peeking tag\n");
3690
3691 // make sure we can peek a tag
3692 if (mpack_reader_error(reader) != mpack_ok)
3693 return mpack_tag_nil();
3694 if (mpack_reader_track_peek_element(reader) != mpack_ok)
3695 return mpack_tag_nil();
3696
3697 mpack_tag_t tag = MPACK_TAG_ZERO;
3698 if (mpack_parse_tag(reader, &tag) == 0)
3699 return mpack_tag_nil();
3700 return tag;
3701}
3702
3703void mpack_discard(mpack_reader_t* reader) {
3704 mpack_tag_t var = mpack_read_tag(reader);
3705 if (mpack_reader_error(reader))
3706 return;
3707 switch (var.type) {
3708 case mpack_type_str:
3709 mpack_skip_bytes(reader, var.v.l);
3710 mpack_done_str(reader);
3711 break;
3712 case mpack_type_bin:
3713 mpack_skip_bytes(reader, var.v.l);
3714 mpack_done_bin(reader);
3715 break;
3716 #if MPACK_EXTENSIONS
3717 case mpack_type_ext:
3718 mpack_skip_bytes(reader, var.v.l);
3719 mpack_done_ext(reader);
3720 break;
3721 #endif
3722 case mpack_type_array: {
3723 for (; var.v.n > 0; --var.v.n) {
3724 mpack_discard(reader);
3725 if (mpack_reader_error(reader))
3726 break;
3727 }
3728 mpack_done_array(reader);
3729 break;
3730 }
3731 case mpack_type_map: {
3732 for (; var.v.n > 0; --var.v.n) {
3733 mpack_discard(reader);
3734 mpack_discard(reader);
3735 if (mpack_reader_error(reader))
3736 break;
3737 }
3738 mpack_done_map(reader);
3739 break;
3740 }
3741 default:
3742 break;
3743 }
3744}
3745
3746#if MPACK_EXTENSIONS
3747mpack_timestamp_t mpack_read_timestamp(mpack_reader_t* reader, size_t size) {
3748 mpack_timestamp_t timestamp = {0, 0};
3749
3750 if (size != 4 && size != 8 && size != 12) {
3751 mpack_reader_flag_error(reader, mpack_error_invalid);
3752 return timestamp;
3753 }
3754
3755 char buf[12];
3756 mpack_read_bytes(reader, buf, size);
3757 mpack_done_ext(reader);
3758 if (mpack_reader_error(reader) != mpack_ok)
3759 return timestamp;
3760
3761 switch (size) {
3762 case 4:
3763 timestamp.seconds = (int64_t)(uint64_t)mpack_load_u32(buf);
3764 break;
3765
3766 case 8: {
3767 uint64_t packed = mpack_load_u64(buf);
3768 timestamp.seconds = (int64_t)(packed & ((MPACK_UINT64_C(1) << 34) - 1));
3769 timestamp.nanoseconds = (uint32_t)(packed >> 34);
3770 break;
3771 }
3772
3773 case 12:
3774 timestamp.nanoseconds = mpack_load_u32(buf);
3775 timestamp.seconds = mpack_load_i64(buf + 4);
3776 break;
3777
3778 default:
3779 mpack_assert(false, "unreachable");
3780 break;
3781 }
3782
3783 if (timestamp.nanoseconds > MPACK_TIMESTAMP_NANOSECONDS_MAX) {
3784 mpack_reader_flag_error(reader, mpack_error_invalid);
3785 mpack_timestamp_t zero = {0, 0};
3786 return zero;
3787 }
3788
3789 return timestamp;
3790}
3791#endif
3792
3793#if MPACK_READ_TRACKING
3794void mpack_done_type(mpack_reader_t* reader, mpack_type_t type) {
3795 if (mpack_reader_error(reader) == mpack_ok)
3796 mpack_reader_flag_if_error(reader, mpack_track_pop(&reader->track, type));
3797}
3798#endif
3799
3800#if MPACK_DEBUG && MPACK_STDIO
3801static size_t mpack_print_read_prefix(mpack_reader_t* reader, size_t length, char* buffer, size_t buffer_size) {
3802 if (length == 0)
3803 return 0;
3804
3805 size_t read = (length < buffer_size) ? length : buffer_size;
3806 mpack_read_bytes(reader, buffer, read);
3807 if (mpack_reader_error(reader) != mpack_ok)
3808 return 0;
3809
3810 mpack_skip_bytes(reader, length - read);
3811 return read;
3812}
3813
3814static void mpack_print_element(mpack_reader_t* reader, mpack_print_t* print, size_t depth) {
3815 mpack_tag_t val = mpack_read_tag(reader);
3816 if (mpack_reader_error(reader) != mpack_ok)
3817 return;
3818
3819 // We read some bytes from bin and ext so we can print its prefix in hex.
3820 char buffer[MPACK_PRINT_BYTE_COUNT];
3821 size_t count = 0;
3822 size_t i, j;
3823
3824 switch (val.type) {
3825 case mpack_type_str:
3826 mpack_print_append_cstr(print, "\"");
3827 for (i = 0; i < val.v.l; ++i) {
3828 char c;
3829 mpack_read_bytes(reader, &c, 1);
3830 if (mpack_reader_error(reader) != mpack_ok)
3831 return;
3832 switch (c) {
3833 case '\n': mpack_print_append_cstr(print, "\\n"); break;
3834 case '\\': mpack_print_append_cstr(print, "\\\\"); break;
3835 case '"': mpack_print_append_cstr(print, "\\\""); break;
3836 default: mpack_print_append(print, &c, 1); break;
3837 }
3838 }
3839 mpack_print_append_cstr(print, "\"");
3840 mpack_done_str(reader);
3841 return;
3842
3843 case mpack_type_array:
3844 mpack_print_append_cstr(print, "[\n");
3845 for (i = 0; i < val.v.n; ++i) {
3846 for (j = 0; j < depth + 1; ++j)
3847 mpack_print_append_cstr(print, " ");
3848 mpack_print_element(reader, print, depth + 1);
3849 if (mpack_reader_error(reader) != mpack_ok)
3850 return;
3851 if (i != val.v.n - 1)
3852 mpack_print_append_cstr(print, ",");
3853 mpack_print_append_cstr(print, "\n");
3854 }
3855 for (i = 0; i < depth; ++i)
3856 mpack_print_append_cstr(print, " ");
3857 mpack_print_append_cstr(print, "]");
3858 mpack_done_array(reader);
3859 return;
3860
3861 case mpack_type_map:
3862 mpack_print_append_cstr(print, "{\n");
3863 for (i = 0; i < val.v.n; ++i) {
3864 for (j = 0; j < depth + 1; ++j)
3865 mpack_print_append_cstr(print, " ");
3866 mpack_print_element(reader, print, depth + 1);
3867 if (mpack_reader_error(reader) != mpack_ok)
3868 return;
3869 mpack_print_append_cstr(print, ": ");
3870 mpack_print_element(reader, print, depth + 1);
3871 if (mpack_reader_error(reader) != mpack_ok)
3872 return;
3873 if (i != val.v.n - 1)
3874 mpack_print_append_cstr(print, ",");
3875 mpack_print_append_cstr(print, "\n");
3876 }
3877 for (i = 0; i < depth; ++i)
3878 mpack_print_append_cstr(print, " ");
3879 mpack_print_append_cstr(print, "}");
3880 mpack_done_map(reader);
3881 return;
3882
3883 // The above cases return so as not to print a pseudo-json value. The
3884 // below cases break and print pseudo-json.
3885
3886 case mpack_type_bin:
3887 count = mpack_print_read_prefix(reader, mpack_tag_bin_length(&val), buffer, sizeof(buffer));
3888 mpack_done_bin(reader);
3889 break;
3890
3891 #if MPACK_EXTENSIONS
3892 case mpack_type_ext:
3893 count = mpack_print_read_prefix(reader, mpack_tag_ext_length(&val), buffer, sizeof(buffer));
3894 mpack_done_ext(reader);
3895 break;
3896 #endif
3897
3898 default:
3899 break;
3900 }
3901
3902 char buf[256];
3903 mpack_tag_debug_pseudo_json(val, buf, sizeof(buf), buffer, count);
3904 mpack_print_append_cstr(print, buf);
3905}
3906
3907static void mpack_print_and_destroy(mpack_reader_t* reader, mpack_print_t* print, size_t depth) {
3908 size_t i;
3909 for (i = 0; i < depth; ++i)
3910 mpack_print_append_cstr(print, " ");
3911 mpack_print_element(reader, print, depth);
3912
3913 size_t remaining = mpack_reader_remaining(reader, NULL);
3914
3915 char buf[256];
3916 if (mpack_reader_destroy(reader) != mpack_ok) {
3917 mpack_snprintf(buf, sizeof(buf), "\n<mpack parsing error %s>", mpack_error_to_string(mpack_reader_error(reader)));
3918 buf[sizeof(buf) - 1] = '\0';
3919 mpack_print_append_cstr(print, buf);
3920 } else if (remaining > 0) {
3921 mpack_snprintf(buf, sizeof(buf), "\n<%i extra bytes at end of message>", (int)remaining);
3922 buf[sizeof(buf) - 1] = '\0';
3923 mpack_print_append_cstr(print, buf);
3924 }
3925}
3926
3927static void mpack_print_data(const char* data, size_t len, mpack_print_t* print, size_t depth) {
3928 mpack_reader_t reader;
3929 mpack_reader_init_data(&reader, data, len);
3930 mpack_print_and_destroy(&reader, print, depth);
3931}
3932
3933void mpack_print_data_to_buffer(const char* data, size_t data_size, char* buffer, size_t buffer_size) {
3934 if (buffer_size == 0) {
3935 mpack_assert(false, "buffer size is zero!");
3936 return;
3937 }
3938
3939 mpack_print_t print;
3940 mpack_memset(&print, 0, sizeof(print));
3941 print.buffer = buffer;
3942 print.size = buffer_size;
3943 mpack_print_data(data, data_size, &print, 0);
3944 mpack_print_append(&print, "", 1); // null-terminator
3945 mpack_print_flush(&print);
3946
3947 // we always make sure there's a null-terminator at the end of the buffer
3948 // in case we ran out of space.
3949 print.buffer[print.size - 1] = '\0';
3950}
3951
3952void mpack_print_data_to_callback(const char* data, size_t size, mpack_print_callback_t callback, void* context) {
3953 char buffer[1024];
3954 mpack_print_t print;
3955 mpack_memset(&print, 0, sizeof(print));
3956 print.buffer = buffer;
3957 print.size = sizeof(buffer);
3958 print.callback = callback;
3959 print.context = context;
3960 mpack_print_data(data, size, &print, 0);
3961 mpack_print_flush(&print);
3962}
3963
3964void mpack_print_data_to_file(const char* data, size_t len, FILE* file) {
3965 mpack_assert(data != NULL, "data is NULL");
3966 mpack_assert(file != NULL, "file is NULL");
3967
3968 char buffer[1024];
3969 mpack_print_t print;
3970 mpack_memset(&print, 0, sizeof(print));
3971 print.buffer = buffer;
3972 print.size = sizeof(buffer);
3973 print.callback = &mpack_print_file_callback;
3974 print.context = file;
3975
3976 mpack_print_data(data, len, &print, 2);
3977 mpack_print_append_cstr(&print, "\n");
3978 mpack_print_flush(&print);
3979}
3980
3981void mpack_print_stdfile_to_callback(FILE* file, mpack_print_callback_t callback, void* context) {
3982 char buffer[1024];
3983 mpack_print_t print;
3984 mpack_memset(&print, 0, sizeof(print));
3985 print.buffer = buffer;
3986 print.size = sizeof(buffer);
3987 print.callback = callback;
3988 print.context = context;
3989
3990 mpack_reader_t reader;
3991 mpack_reader_init_stdfile(&reader, file, false);
3992 mpack_print_and_destroy(&reader, &print, 0);
3993 mpack_print_flush(&print);
3994}
3995#endif
3996
3997#endif
3998
3999MPACK_SILENCE_WARNINGS_END
4000
4001/* mpack/mpack-expect.c.c */
4002
4003#define MPACK_INTERNAL 1
4004
4005/* #include "mpack-expect.h" */
4006
4007MPACK_SILENCE_WARNINGS_BEGIN
4008
4009#if MPACK_EXPECT
4010
4011
4012// Helpers
4013
4014MPACK_STATIC_INLINE uint8_t mpack_expect_native_u8(mpack_reader_t* reader) {
4015 if (mpack_reader_error(reader) != mpack_ok)
4016 return 0;
4017 uint8_t type;
4018 if (!mpack_reader_ensure(reader, sizeof(type)))
4019 return 0;
4020 type = mpack_load_u8(reader->data);
4021 reader->data += sizeof(type);
4022 return type;
4023}
4024
4025#if !MPACK_OPTIMIZE_FOR_SIZE
4026MPACK_STATIC_INLINE uint16_t mpack_expect_native_u16(mpack_reader_t* reader) {
4027 if (mpack_reader_error(reader) != mpack_ok)
4028 return 0;
4029 uint16_t type;
4030 if (!mpack_reader_ensure(reader, sizeof(type)))
4031 return 0;
4032 type = mpack_load_u16(reader->data);
4033 reader->data += sizeof(type);
4034 return type;
4035}
4036
4037MPACK_STATIC_INLINE uint32_t mpack_expect_native_u32(mpack_reader_t* reader) {
4038 if (mpack_reader_error(reader) != mpack_ok)
4039 return 0;
4040 uint32_t type;
4041 if (!mpack_reader_ensure(reader, sizeof(type)))
4042 return 0;
4043 type = mpack_load_u32(reader->data);
4044 reader->data += sizeof(type);
4045 return type;
4046}
4047#endif
4048
4049MPACK_STATIC_INLINE uint8_t mpack_expect_type_byte(mpack_reader_t* reader) {
4050 mpack_reader_track_element(reader);
4051 return mpack_expect_native_u8(reader);
4052}
4053
4054
4055// Basic Number Functions
4056
4057uint8_t mpack_expect_u8(mpack_reader_t* reader) {
4058 mpack_tag_t var = mpack_read_tag(reader);
4059 if (var.type == mpack_type_uint) {
4060 if (var.v.u <= MPACK_UINT8_MAX)
4061 return (uint8_t)var.v.u;
4062 } else if (var.type == mpack_type_int) {
4063 if (var.v.i >= 0 && var.v.i <= MPACK_UINT8_MAX)
4064 return (uint8_t)var.v.i;
4065 }
4066 mpack_reader_flag_error(reader, mpack_error_type);
4067 return 0;
4068}
4069
4070uint16_t mpack_expect_u16(mpack_reader_t* reader) {
4071 mpack_tag_t var = mpack_read_tag(reader);
4072 if (var.type == mpack_type_uint) {
4073 if (var.v.u <= MPACK_UINT16_MAX)
4074 return (uint16_t)var.v.u;
4075 } else if (var.type == mpack_type_int) {
4076 if (var.v.i >= 0 && var.v.i <= MPACK_UINT16_MAX)
4077 return (uint16_t)var.v.i;
4078 }
4079 mpack_reader_flag_error(reader, mpack_error_type);
4080 return 0;
4081}
4082
4083uint32_t mpack_expect_u32(mpack_reader_t* reader) {
4084 mpack_tag_t var = mpack_read_tag(reader);
4085 if (var.type == mpack_type_uint) {
4086 if (var.v.u <= MPACK_UINT32_MAX)
4087 return (uint32_t)var.v.u;
4088 } else if (var.type == mpack_type_int) {
4089 if (var.v.i >= 0 && var.v.i <= MPACK_UINT32_MAX)
4090 return (uint32_t)var.v.i;
4091 }
4092 mpack_reader_flag_error(reader, mpack_error_type);
4093 return 0;
4094}
4095
4096uint64_t mpack_expect_u64(mpack_reader_t* reader) {
4097 mpack_tag_t var = mpack_read_tag(reader);
4098 if (var.type == mpack_type_uint) {
4099 return var.v.u;
4100 } else if (var.type == mpack_type_int) {
4101 if (var.v.i >= 0)
4102 return (uint64_t)var.v.i;
4103 }
4104 mpack_reader_flag_error(reader, mpack_error_type);
4105 return 0;
4106}
4107
4108int8_t mpack_expect_i8(mpack_reader_t* reader) {
4109 mpack_tag_t var = mpack_read_tag(reader);
4110 if (var.type == mpack_type_uint) {
4111 if (var.v.u <= MPACK_INT8_MAX)
4112 return (int8_t)var.v.u;
4113 } else if (var.type == mpack_type_int) {
4114 if (var.v.i >= MPACK_INT8_MIN && var.v.i <= MPACK_INT8_MAX)
4115 return (int8_t)var.v.i;
4116 }
4117 mpack_reader_flag_error(reader, mpack_error_type);
4118 return 0;
4119}
4120
4121int16_t mpack_expect_i16(mpack_reader_t* reader) {
4122 mpack_tag_t var = mpack_read_tag(reader);
4123 if (var.type == mpack_type_uint) {
4124 if (var.v.u <= MPACK_INT16_MAX)
4125 return (int16_t)var.v.u;
4126 } else if (var.type == mpack_type_int) {
4127 if (var.v.i >= MPACK_INT16_MIN && var.v.i <= MPACK_INT16_MAX)
4128 return (int16_t)var.v.i;
4129 }
4130 mpack_reader_flag_error(reader, mpack_error_type);
4131 return 0;
4132}
4133
4134int32_t mpack_expect_i32(mpack_reader_t* reader) {
4135 mpack_tag_t var = mpack_read_tag(reader);
4136 if (var.type == mpack_type_uint) {
4137 if (var.v.u <= MPACK_INT32_MAX)
4138 return (int32_t)var.v.u;
4139 } else if (var.type == mpack_type_int) {
4140 if (var.v.i >= MPACK_INT32_MIN && var.v.i <= MPACK_INT32_MAX)
4141 return (int32_t)var.v.i;
4142 }
4143 mpack_reader_flag_error(reader, mpack_error_type);
4144 return 0;
4145}
4146
4147int64_t mpack_expect_i64(mpack_reader_t* reader) {
4148 mpack_tag_t var = mpack_read_tag(reader);
4149 if (var.type == mpack_type_uint) {
4150 if (var.v.u <= MPACK_INT64_MAX)
4151 return (int64_t)var.v.u;
4152 } else if (var.type == mpack_type_int) {
4153 return var.v.i;
4154 }
4155 mpack_reader_flag_error(reader, mpack_error_type);
4156 return 0;
4157}
4158
4159#if MPACK_FLOAT
4160float mpack_expect_float(mpack_reader_t* reader) {
4161 mpack_tag_t var = mpack_read_tag(reader);
4162 if (var.type == mpack_type_uint)
4163 return (float)var.v.u;
4164 if (var.type == mpack_type_int)
4165 return (float)var.v.i;
4166 if (var.type == mpack_type_float)
4167 return var.v.f;
4168
4169 if (var.type == mpack_type_double) {
4170 #if MPACK_DOUBLE
4171 return (float)var.v.d;
4172 #else
4173 return mpack_shorten_raw_double_to_float(var.v.d);
4174 #endif
4175 }
4176
4177 mpack_reader_flag_error(reader, mpack_error_type);
4178 return 0.0f;
4179}
4180#endif
4181
4182#if MPACK_DOUBLE
4183double mpack_expect_double(mpack_reader_t* reader) {
4184 mpack_tag_t var = mpack_read_tag(reader);
4185 if (var.type == mpack_type_uint)
4186 return (double)var.v.u;
4187 else if (var.type == mpack_type_int)
4188 return (double)var.v.i;
4189 else if (var.type == mpack_type_float)
4190 return (double)var.v.f;
4191 else if (var.type == mpack_type_double)
4192 return var.v.d;
4193 mpack_reader_flag_error(reader, mpack_error_type);
4194 return 0.0;
4195}
4196#endif
4197
4198#if MPACK_FLOAT
4199float mpack_expect_float_strict(mpack_reader_t* reader) {
4200 mpack_tag_t var = mpack_read_tag(reader);
4201 if (var.type == mpack_type_float)
4202 return var.v.f;
4203 mpack_reader_flag_error(reader, mpack_error_type);
4204 return 0.0f;
4205}
4206#endif
4207
4208#if MPACK_DOUBLE
4209double mpack_expect_double_strict(mpack_reader_t* reader) {
4210 mpack_tag_t var = mpack_read_tag(reader);
4211 if (var.type == mpack_type_float)
4212 return (double)var.v.f;
4213 else if (var.type == mpack_type_double)
4214 return var.v.d;
4215 mpack_reader_flag_error(reader, mpack_error_type);
4216 return 0.0;
4217}
4218#endif
4219
4220#if !MPACK_FLOAT
4221uint32_t mpack_expect_raw_float(mpack_reader_t* reader) {
4222 mpack_tag_t var = mpack_read_tag(reader);
4223 if (var.type == mpack_type_float)
4224 return var.v.f;
4225 mpack_reader_flag_error(reader, mpack_error_type);
4226 return 0;
4227}
4228#endif
4229
4230#if !MPACK_DOUBLE
4231uint64_t mpack_expect_raw_double(mpack_reader_t* reader) {
4232 mpack_tag_t var = mpack_read_tag(reader);
4233 if (var.type == mpack_type_double)
4234 return var.v.d;
4235 mpack_reader_flag_error(reader, mpack_error_type);
4236 return 0;
4237}
4238#endif
4239
4240
4241// Ranged Number Functions
4242//
4243// All ranged functions are identical other than the type, so we
4244// define their content with a macro. The prototypes are still written
4245// out in full to support ctags/IDE tools.
4246
4247#define MPACK_EXPECT_RANGE_IMPL(name, type_t) \
4248 \
4249 /* make sure the range is sensible */ \
4250 mpack_assert(min_value <= max_value, \
4251 "min_value %i must be less than or equal to max_value %i", \
4252 min_value, max_value); \
4253 \
4254 /* read the value */ \
4255 type_t val = mpack_expect_##name(reader); \
4256 if (mpack_reader_error(reader) != mpack_ok) \
4257 return min_value; \
4258 \
4259 /* make sure it fits */ \
4260 if (val < min_value || val > max_value) { \
4261 mpack_reader_flag_error(reader, mpack_error_type); \
4262 return min_value; \
4263 } \
4264 \
4265 return val;
4266
4267uint8_t mpack_expect_u8_range(mpack_reader_t* reader, uint8_t min_value, uint8_t max_value) {MPACK_EXPECT_RANGE_IMPL(u8, uint8_t)}
4268uint16_t mpack_expect_u16_range(mpack_reader_t* reader, uint16_t min_value, uint16_t max_value) {MPACK_EXPECT_RANGE_IMPL(u16, uint16_t)}
4269uint32_t mpack_expect_u32_range(mpack_reader_t* reader, uint32_t min_value, uint32_t max_value) {MPACK_EXPECT_RANGE_IMPL(u32, uint32_t)}
4270uint64_t mpack_expect_u64_range(mpack_reader_t* reader, uint64_t min_value, uint64_t max_value) {MPACK_EXPECT_RANGE_IMPL(u64, uint64_t)}
4271
4272int8_t mpack_expect_i8_range(mpack_reader_t* reader, int8_t min_value, int8_t max_value) {MPACK_EXPECT_RANGE_IMPL(i8, int8_t)}
4273int16_t mpack_expect_i16_range(mpack_reader_t* reader, int16_t min_value, int16_t max_value) {MPACK_EXPECT_RANGE_IMPL(i16, int16_t)}
4274int32_t mpack_expect_i32_range(mpack_reader_t* reader, int32_t min_value, int32_t max_value) {MPACK_EXPECT_RANGE_IMPL(i32, int32_t)}
4275int64_t mpack_expect_i64_range(mpack_reader_t* reader, int64_t min_value, int64_t max_value) {MPACK_EXPECT_RANGE_IMPL(i64, int64_t)}
4276
4277#if MPACK_FLOAT
4278float mpack_expect_float_range(mpack_reader_t* reader, float min_value, float max_value) {MPACK_EXPECT_RANGE_IMPL(float, float)}
4279#endif
4280#if MPACK_DOUBLE
4281double mpack_expect_double_range(mpack_reader_t* reader, double min_value, double max_value) {MPACK_EXPECT_RANGE_IMPL(double, double)}
4282#endif
4283
4284uint32_t mpack_expect_map_range(mpack_reader_t* reader, uint32_t min_value, uint32_t max_value) {MPACK_EXPECT_RANGE_IMPL(map, uint32_t)}
4285uint32_t mpack_expect_array_range(mpack_reader_t* reader, uint32_t min_value, uint32_t max_value) {MPACK_EXPECT_RANGE_IMPL(array, uint32_t)}
4286
4287
4288// Matching Number Functions
4289
4290void mpack_expect_uint_match(mpack_reader_t* reader, uint64_t value) {
4291 if (mpack_expect_u64(reader) != value)
4292 mpack_reader_flag_error(reader, mpack_error_type);
4293}
4294
4295void mpack_expect_int_match(mpack_reader_t* reader, int64_t value) {
4296 if (mpack_expect_i64(reader) != value)
4297 mpack_reader_flag_error(reader, mpack_error_type);
4298}
4299
4300
4301// Other Basic Types
4302
4303void mpack_expect_nil(mpack_reader_t* reader) {
4304 if (mpack_expect_type_byte(reader) != 0xc0)
4305 mpack_reader_flag_error(reader, mpack_error_type);
4306}
4307
4308bool mpack_expect_bool(mpack_reader_t* reader) {
4309 uint8_t type = mpack_expect_type_byte(reader);
4310 if ((type & ~1) != 0xc2)
4311 mpack_reader_flag_error(reader, mpack_error_type);
4312 return (bool)(type & 1);
4313}
4314
4315void mpack_expect_true(mpack_reader_t* reader) {
4316 if (mpack_expect_bool(reader) != true)
4317 mpack_reader_flag_error(reader, mpack_error_type);
4318}
4319
4320void mpack_expect_false(mpack_reader_t* reader) {
4321 if (mpack_expect_bool(reader) != false)
4322 mpack_reader_flag_error(reader, mpack_error_type);
4323}
4324
4325#if MPACK_EXTENSIONS
4326mpack_timestamp_t mpack_expect_timestamp(mpack_reader_t* reader) {
4327 mpack_timestamp_t zero = {0, 0};
4328
4329 mpack_tag_t tag = mpack_read_tag(reader);
4330 if (tag.type != mpack_type_ext) {
4331 mpack_reader_flag_error(reader, mpack_error_type);
4332 return zero;
4333 }
4334 if (mpack_tag_ext_exttype(&tag) != MPACK_EXTTYPE_TIMESTAMP) {
4335 mpack_reader_flag_error(reader, mpack_error_type);
4336 return zero;
4337 }
4338
4339 return mpack_read_timestamp(reader, mpack_tag_ext_length(&tag));
4340}
4341
4342int64_t mpack_expect_timestamp_truncate(mpack_reader_t* reader) {
4343 return mpack_expect_timestamp(reader).seconds;
4344}
4345#endif
4346
4347
4348// Compound Types
4349
4350uint32_t mpack_expect_map(mpack_reader_t* reader) {
4351 mpack_tag_t var = mpack_read_tag(reader);
4352 if (var.type == mpack_type_map)
4353 return var.v.n;
4354 mpack_reader_flag_error(reader, mpack_error_type);
4355 return 0;
4356}
4357
4358void mpack_expect_map_match(mpack_reader_t* reader, uint32_t count) {
4359 if (mpack_expect_map(reader) != count)
4360 mpack_reader_flag_error(reader, mpack_error_type);
4361}
4362
4363bool mpack_expect_map_or_nil(mpack_reader_t* reader, uint32_t* count) {
4364 mpack_assert(count != NULL, "count cannot be NULL");
4365
4366 mpack_tag_t var = mpack_read_tag(reader);
4367 if (var.type == mpack_type_nil) {
4368 *count = 0;
4369 return false;
4370 }
4371 if (var.type == mpack_type_map) {
4372 *count = var.v.n;
4373 return true;
4374 }
4375 mpack_reader_flag_error(reader, mpack_error_type);
4376 *count = 0;
4377 return false;
4378}
4379
4380bool mpack_expect_map_max_or_nil(mpack_reader_t* reader, uint32_t max_count, uint32_t* count) {
4381 mpack_assert(count != NULL, "count cannot be NULL");
4382
4383 bool has_map = mpack_expect_map_or_nil(reader, count);
4384 if (has_map && *count > max_count) {
4385 *count = 0;
4386 mpack_reader_flag_error(reader, mpack_error_type);
4387 return false;
4388 }
4389 return has_map;
4390}
4391
4392uint32_t mpack_expect_array(mpack_reader_t* reader) {
4393 mpack_tag_t var = mpack_read_tag(reader);
4394 if (var.type == mpack_type_array)
4395 return var.v.n;
4396 mpack_reader_flag_error(reader, mpack_error_type);
4397 return 0;
4398}
4399
4400void mpack_expect_array_match(mpack_reader_t* reader, uint32_t count) {
4401 if (mpack_expect_array(reader) != count)
4402 mpack_reader_flag_error(reader, mpack_error_type);
4403}
4404
4405bool mpack_expect_array_or_nil(mpack_reader_t* reader, uint32_t* count) {
4406 mpack_assert(count != NULL, "count cannot be NULL");
4407
4408 mpack_tag_t var = mpack_read_tag(reader);
4409 if (var.type == mpack_type_nil) {
4410 *count = 0;
4411 return false;
4412 }
4413 if (var.type == mpack_type_array) {
4414 *count = var.v.n;
4415 return true;
4416 }
4417 mpack_reader_flag_error(reader, mpack_error_type);
4418 *count = 0;
4419 return false;
4420}
4421
4422bool mpack_expect_array_max_or_nil(mpack_reader_t* reader, uint32_t max_count, uint32_t* count) {
4423 mpack_assert(count != NULL, "count cannot be NULL");
4424
4425 bool has_array = mpack_expect_array_or_nil(reader, count);
4426 if (has_array && *count > max_count) {
4427 *count = 0;
4428 mpack_reader_flag_error(reader, mpack_error_type);
4429 return false;
4430 }
4431 return has_array;
4432}
4433
4434#ifdef MPACK_MALLOC
4435void* mpack_expect_array_alloc_impl(mpack_reader_t* reader, size_t element_size, uint32_t max_count, uint32_t* out_count, bool allow_nil) {
4436 mpack_assert(out_count != NULL, "out_count cannot be NULL");
4437 *out_count = 0;
4438
4439 uint32_t count;
4440 bool has_array = true;
4441 if (allow_nil)
4442 has_array = mpack_expect_array_max_or_nil(reader, max_count, &count);
4443 else
4444 count = mpack_expect_array_max(reader, max_count);
4445 if (mpack_reader_error(reader))
4446 return NULL;
4447
4448 // size 0 is not an error; we return NULL for no elements.
4449 if (count == 0) {
4450 // we call mpack_done_array() automatically ONLY if we are using
4451 // the _or_nil variant. this is the only way to allow nil and empty
4452 // to work the same way.
4453 if (allow_nil && has_array)
4454 mpack_done_array(reader);
4455 return NULL;
4456 }
4457
4458 void* p = MPACK_MALLOC(element_size * count);
4459 if (p == NULL) {
4460 mpack_reader_flag_error(reader, mpack_error_memory);
4461 return NULL;
4462 }
4463
4464 *out_count = count;
4465 return p;
4466}
4467#endif
4468
4469
4470// Str, Bin and Ext Functions
4471
4472uint32_t mpack_expect_str(mpack_reader_t* reader) {
4473 #if MPACK_OPTIMIZE_FOR_SIZE
4474 mpack_tag_t var = mpack_read_tag(reader);
4475 if (var.type == mpack_type_str)
4476 return var.v.l;
4477 mpack_reader_flag_error(reader, mpack_error_type);
4478 return 0;
4479 #else
4480 uint8_t type = mpack_expect_type_byte(reader);
4481 uint32_t count;
4482
4483 if ((type >> 5) == 5) {
4484 count = type & (uint8_t)~0xe0;
4485 } else if (type == 0xd9) {
4486 count = mpack_expect_native_u8(reader);
4487 } else if (type == 0xda) {
4488 count = mpack_expect_native_u16(reader);
4489 } else if (type == 0xdb) {
4490 count = mpack_expect_native_u32(reader);
4491 } else {
4492 mpack_reader_flag_error(reader, mpack_error_type);
4493 return 0;
4494 }
4495
4496 #if MPACK_READ_TRACKING
4497 mpack_reader_flag_if_error(reader, mpack_track_push(&reader->track, mpack_type_str, count));
4498 #endif
4499 return count;
4500 #endif
4501}
4502
4503size_t mpack_expect_str_buf(mpack_reader_t* reader, char* buf, size_t bufsize) {
4504 mpack_assert(buf != NULL, "buf cannot be NULL");
4505
4506 size_t length = mpack_expect_str(reader);
4507 if (mpack_reader_error(reader))
4508 return 0;
4509
4510 if (length > bufsize) {
4511 mpack_reader_flag_error(reader, mpack_error_too_big);
4512 return 0;
4513 }
4514
4515 mpack_read_bytes(reader, buf, length);
4516 if (mpack_reader_error(reader))
4517 return 0;
4518
4519 mpack_done_str(reader);
4520 return length;
4521}
4522
4523size_t mpack_expect_utf8(mpack_reader_t* reader, char* buf, size_t size) {
4524 mpack_assert(buf != NULL, "buf cannot be NULL");
4525
4526 size_t length = mpack_expect_str_buf(reader, buf, size);
4527
4528 if (!mpack_utf8_check(buf, length)) {
4529 mpack_reader_flag_error(reader, mpack_error_type);
4530 return 0;
4531 }
4532
4533 return length;
4534}
4535
4536uint32_t mpack_expect_bin(mpack_reader_t* reader) {
4537 mpack_tag_t var = mpack_read_tag(reader);
4538 if (var.type == mpack_type_bin)
4539 return var.v.l;
4540 mpack_reader_flag_error(reader, mpack_error_type);
4541 return 0;
4542}
4543
4544size_t mpack_expect_bin_buf(mpack_reader_t* reader, char* buf, size_t bufsize) {
4545 mpack_assert(buf != NULL, "buf cannot be NULL");
4546
4547 size_t binsize = mpack_expect_bin(reader);
4548 if (mpack_reader_error(reader))
4549 return 0;
4550 if (binsize > bufsize) {
4551 mpack_reader_flag_error(reader, mpack_error_too_big);
4552 return 0;
4553 }
4554 mpack_read_bytes(reader, buf, binsize);
4555 if (mpack_reader_error(reader))
4556 return 0;
4557 mpack_done_bin(reader);
4558 return binsize;
4559}
4560
4561void mpack_expect_bin_size_buf(mpack_reader_t* reader, char* buf, uint32_t size) {
4562 mpack_assert(buf != NULL, "buf cannot be NULL");
4563 mpack_expect_bin_size(reader, size);
4564 mpack_read_bytes(reader, buf, size);
4565 mpack_done_bin(reader);
4566}
4567
4568#if MPACK_EXTENSIONS
4569uint32_t mpack_expect_ext(mpack_reader_t* reader, int8_t* type) {
4570 mpack_tag_t var = mpack_read_tag(reader);
4571 if (var.type == mpack_type_ext) {
4572 *type = mpack_tag_ext_exttype(&var);
4573 return mpack_tag_ext_length(&var);
4574 }
4575 *type = 0;
4576 mpack_reader_flag_error(reader, mpack_error_type);
4577 return 0;
4578}
4579
4580size_t mpack_expect_ext_buf(mpack_reader_t* reader, int8_t* type, char* buf, size_t bufsize) {
4581 mpack_assert(buf != NULL, "buf cannot be NULL");
4582
4583 size_t extsize = mpack_expect_ext(reader, type);
4584 if (mpack_reader_error(reader))
4585 return 0;
4586 if (extsize > bufsize) {
4587 *type = 0;
4588 mpack_reader_flag_error(reader, mpack_error_too_big);
4589 return 0;
4590 }
4591 mpack_read_bytes(reader, buf, extsize);
4592 if (mpack_reader_error(reader)) {
4593 *type = 0;
4594 return 0;
4595 }
4596 mpack_done_ext(reader);
4597 return extsize;
4598}
4599#endif
4600
4601void mpack_expect_cstr(mpack_reader_t* reader, char* buf, size_t bufsize) {
4602 uint32_t length = mpack_expect_str(reader);
4603 mpack_read_cstr(reader, buf, bufsize, length);
4604 mpack_done_str(reader);
4605}
4606
4607void mpack_expect_utf8_cstr(mpack_reader_t* reader, char* buf, size_t bufsize) {
4608 uint32_t length = mpack_expect_str(reader);
4609 mpack_read_utf8_cstr(reader, buf, bufsize, length);
4610 mpack_done_str(reader);
4611}
4612
4613#ifdef MPACK_MALLOC
4614static char* mpack_expect_cstr_alloc_unchecked(mpack_reader_t* reader, size_t maxsize, size_t* out_length) {
4615 mpack_assert(out_length != NULL, "out_length cannot be NULL");
4616 *out_length = 0;
4617
4618 // make sure argument makes sense
4619 if (maxsize < 1) {
4620 mpack_break("maxsize is zero; you must have room for at least a null-terminator");
4621 mpack_reader_flag_error(reader, mpack_error_bug);
4622 return NULL;
4623 }
4624
4625 if (SIZE_MAX < MPACK_UINT32_MAX) {
4626 if (maxsize > SIZE_MAX)
4627 maxsize = SIZE_MAX;
4628 } else {
4629 if (maxsize > (size_t)MPACK_UINT32_MAX)
4630 maxsize = (size_t)MPACK_UINT32_MAX;
4631 }
4632
4633 size_t length = mpack_expect_str_max(reader, (uint32_t)maxsize - 1);
4634 char* str = mpack_read_bytes_alloc_impl(reader, length, true);
4635 mpack_done_str(reader);
4636
4637 if (str)
4638 *out_length = length;
4639 return str;
4640}
4641
4642char* mpack_expect_cstr_alloc(mpack_reader_t* reader, size_t maxsize) {
4643 size_t length;
4644 char* str = mpack_expect_cstr_alloc_unchecked(reader, maxsize, &length);
4645
4646 if (str && !mpack_str_check_no_null(str, length)) {
4647 MPACK_FREE(str);
4648 mpack_reader_flag_error(reader, mpack_error_type);
4649 return NULL;
4650 }
4651
4652 return str;
4653}
4654
4655char* mpack_expect_utf8_cstr_alloc(mpack_reader_t* reader, size_t maxsize) {
4656 size_t length;
4657 char* str = mpack_expect_cstr_alloc_unchecked(reader, maxsize, &length);
4658
4659 if (str && !mpack_utf8_check_no_null(str, length)) {
4660 MPACK_FREE(str);
4661 mpack_reader_flag_error(reader, mpack_error_type);
4662 return NULL;
4663 }
4664
4665 return str;
4666}
4667#endif
4668
4669void mpack_expect_str_match(mpack_reader_t* reader, const char* str, size_t len) {
4670 mpack_assert(str != NULL, "str cannot be NULL");
4671
4672 // expect a str the correct length
4673 if (len > MPACK_UINT32_MAX)
4674 mpack_reader_flag_error(reader, mpack_error_type);
4675 mpack_expect_str_length(reader, (uint32_t)len);
4676 if (mpack_reader_error(reader))
4677 return;
4678 mpack_reader_track_bytes(reader, (uint32_t)len);
4679
4680 // check each byte one by one (matched strings are likely to be very small)
4681 for (; len > 0; --len) {
4682 if (mpack_expect_native_u8(reader) != *str++) {
4683 mpack_reader_flag_error(reader, mpack_error_type);
4684 return;
4685 }
4686 }
4687
4688 mpack_done_str(reader);
4689}
4690
4691void mpack_expect_tag(mpack_reader_t* reader, mpack_tag_t expected) {
4692 mpack_tag_t actual = mpack_read_tag(reader);
4693 if (!mpack_tag_equal(actual, expected))
4694 mpack_reader_flag_error(reader, mpack_error_type);
4695}
4696
4697#ifdef MPACK_MALLOC
4698char* mpack_expect_bin_alloc(mpack_reader_t* reader, size_t maxsize, size_t* size) {
4699 mpack_assert(size != NULL, "size cannot be NULL");
4700 *size = 0;
4701
4702 if (SIZE_MAX < MPACK_UINT32_MAX) {
4703 if (maxsize > SIZE_MAX)
4704 maxsize = SIZE_MAX;
4705 } else {
4706 if (maxsize > (size_t)MPACK_UINT32_MAX)
4707 maxsize = (size_t)MPACK_UINT32_MAX;
4708 }
4709
4710 size_t length = mpack_expect_bin_max(reader, (uint32_t)maxsize);
4711 if (mpack_reader_error(reader))
4712 return NULL;
4713
4714 char* data = mpack_read_bytes_alloc(reader, length);
4715 mpack_done_bin(reader);
4716
4717 if (data)
4718 *size = length;
4719 return data;
4720}
4721#endif
4722
4723#if MPACK_EXTENSIONS && defined(MPACK_MALLOC)
4724char* mpack_expect_ext_alloc(mpack_reader_t* reader, int8_t* type, size_t maxsize, size_t* size) {
4725 mpack_assert(size != NULL, "size cannot be NULL");
4726 *size = 0;
4727
4728 if (SIZE_MAX < MPACK_UINT32_MAX) {
4729 if (maxsize > SIZE_MAX)
4730 maxsize = SIZE_MAX;
4731 } else {
4732 if (maxsize > (size_t)MPACK_UINT32_MAX)
4733 maxsize = (size_t)MPACK_UINT32_MAX;
4734 }
4735
4736 size_t length = mpack_expect_ext_max(reader, type, (uint32_t)maxsize);
4737 if (mpack_reader_error(reader))
4738 return NULL;
4739
4740 char* data = mpack_read_bytes_alloc(reader, length);
4741 mpack_done_ext(reader);
4742
4743 if (data) {
4744 *size = length;
4745 } else {
4746 *type = 0;
4747 }
4748 return data;
4749}
4750#endif
4751
4752size_t mpack_expect_enum(mpack_reader_t* reader, const char* strings[], size_t count) {
4753
4754 // read the string in-place
4755 size_t keylen = mpack_expect_str(reader);
4756 const char* key = mpack_read_bytes_inplace(reader, keylen);
4757 mpack_done_str(reader);
4758 if (mpack_reader_error(reader) != mpack_ok)
4759 return count;
4760
4761 // find what key it matches
4762 size_t i;
4763 for (i = 0; i < count; ++i) {
4764 const char* other = strings[i];
4765 size_t otherlen = mpack_strlen(other);
4766 if (keylen == otherlen && mpack_memcmp(key, other, keylen) == 0)
4767 return i;
4768 }
4769
4770 // no matches
4771 mpack_reader_flag_error(reader, mpack_error_type);
4772 return count;
4773}
4774
4775size_t mpack_expect_enum_optional(mpack_reader_t* reader, const char* strings[], size_t count) {
4776 if (mpack_reader_error(reader) != mpack_ok)
4777 return count;
4778
4779 mpack_assert(count != 0, "count cannot be zero; no strings are valid!");
4780 mpack_assert(strings != NULL, "strings cannot be NULL");
4781
4782 // the key is only recognized if it is a string
4783 if (mpack_peek_tag(reader).type != mpack_type_str) {
4784 mpack_discard(reader);
4785 return count;
4786 }
4787
4788 // read the string in-place
4789 size_t keylen = mpack_expect_str(reader);
4790 const char* key = mpack_read_bytes_inplace(reader, keylen);
4791 mpack_done_str(reader);
4792 if (mpack_reader_error(reader) != mpack_ok)
4793 return count;
4794
4795 // find what key it matches
4796 size_t i;
4797 for (i = 0; i < count; ++i) {
4798 const char* other = strings[i];
4799 size_t otherlen = mpack_strlen(other);
4800 if (keylen == otherlen && mpack_memcmp(key, other, keylen) == 0)
4801 return i;
4802 }
4803
4804 // no matches
4805 return count;
4806}
4807
4808size_t mpack_expect_key_uint(mpack_reader_t* reader, bool found[], size_t count) {
4809 if (mpack_reader_error(reader) != mpack_ok)
4810 return count;
4811
4812 if (count == 0) {
4813 mpack_break("count cannot be zero; no keys are valid!");
4814 mpack_reader_flag_error(reader, mpack_error_bug);
4815 return count;
4816 }
4817 mpack_assert(found != NULL, "found cannot be NULL");
4818
4819 // the key is only recognized if it is an unsigned int
4820 if (mpack_peek_tag(reader).type != mpack_type_uint) {
4821 mpack_discard(reader);
4822 return count;
4823 }
4824
4825 // read the key
4826 uint64_t value = mpack_expect_u64(reader);
4827 if (mpack_reader_error(reader) != mpack_ok)
4828 return count;
4829
4830 // unrecognized keys are fine, we just return count
4831 if (value >= count)
4832 return count;
4833
4834 // check if this key is a duplicate
4835 if (found[value]) {
4836 mpack_reader_flag_error(reader, mpack_error_invalid);
4837 return count;
4838 }
4839
4840 found[value] = true;
4841 return (size_t)value;
4842}
4843
4844size_t mpack_expect_key_cstr(mpack_reader_t* reader, const char* keys[], bool found[], size_t count) {
4845 size_t i = mpack_expect_enum_optional(reader, keys, count);
4846
4847 // unrecognized keys are fine, we just return count
4848 if (i == count)
4849 return count;
4850
4851 // check if this key is a duplicate
4852 mpack_assert(found != NULL, "found cannot be NULL");
4853 if (found[i]) {
4854 mpack_reader_flag_error(reader, mpack_error_invalid);
4855 return count;
4856 }
4857
4858 found[i] = true;
4859 return i;
4860}
4861
4862#endif
4863
4864MPACK_SILENCE_WARNINGS_END
4865
4866/* mpack/mpack-node.c.c */
4867
4868#define MPACK_INTERNAL 1
4869
4870/* #include "mpack-node.h" */
4871
4872MPACK_SILENCE_WARNINGS_BEGIN
4873
4874#if MPACK_NODE
4875
4876MPACK_STATIC_INLINE const char* mpack_node_data_unchecked(mpack_node_t node) {
4877 mpack_assert(mpack_node_error(node) == mpack_ok, "tree is in an error state!");
4878
4879 mpack_type_t type = node.data->type;
4880 MPACK_UNUSED(type);
4881 #if MPACK_EXTENSIONS
4882 mpack_assert(type == mpack_type_str || type == mpack_type_bin || type == mpack_type_ext,
4883 "node of type %i (%s) is not a data type!", type, mpack_type_to_string(type));
4884 #else
4885 mpack_assert(type == mpack_type_str || type == mpack_type_bin,
4886 "node of type %i (%s) is not a data type!", type, mpack_type_to_string(type));
4887 #endif
4888
4889 return node.tree->data + node.data->value.offset;
4890}
4891
4892#if MPACK_EXTENSIONS
4893MPACK_STATIC_INLINE int8_t mpack_node_exttype_unchecked(mpack_node_t node) {
4894 mpack_assert(mpack_node_error(node) == mpack_ok, "tree is in an error state!");
4895
4896 mpack_type_t type = node.data->type;
4897 MPACK_UNUSED(type);
4898 mpack_assert(type == mpack_type_ext, "node of type %i (%s) is not an ext type!",
4899 type, mpack_type_to_string(type));
4900
4901 // the exttype of an ext node is stored in the byte preceding the data
4902 return mpack_load_i8(mpack_node_data_unchecked(node) - 1);
4903}
4904#endif
4905
4906
4907
4908/*
4909 * Tree Parsing
4910 */
4911
4912#ifdef MPACK_MALLOC
4913
4914// fix up the alloc size to make sure it exactly fits the
4915// maximum number of nodes it can contain (the allocator will
4916// waste it back anyway, but we round it down just in case)
4917
4918#define MPACK_NODES_PER_PAGE \
4919 ((MPACK_NODE_PAGE_SIZE - sizeof(mpack_tree_page_t)) / sizeof(mpack_node_data_t) + 1)
4920
4921#define MPACK_PAGE_ALLOC_SIZE \
4922 (sizeof(mpack_tree_page_t) + sizeof(mpack_node_data_t) * (MPACK_NODES_PER_PAGE - 1))
4923
4924#endif
4925
4926#ifdef MPACK_MALLOC
4927/*
4928 * Fills the tree until we have at least enough bytes for the current node.
4929 */
4930static bool mpack_tree_reserve_fill(mpack_tree_t* tree) {
4931 mpack_assert(tree->parser.state == mpack_tree_parse_state_in_progress);
4932
4933 size_t bytes = tree->parser.current_node_reserved;
4934 mpack_assert(bytes > tree->parser.possible_nodes_left,
4935 "there are already enough bytes! call mpack_tree_ensure() instead.");
4936 mpack_log("filling to reserve %i bytes\n", (int)bytes);
4937
4938 // if the necessary bytes would put us over the maximum tree
4939 // size, fail right away.
4940 // TODO: check for overflow?
4941 if (tree->data_length + bytes > tree->max_size) {
4942 mpack_tree_flag_error(tree, mpack_error_too_big);
4943 return false;
4944 }
4945
4946 // we'll need a read function to fetch more data. if there's
4947 // no read function, the data should contain an entire message
4948 // (or messages), so we flag it as invalid.
4949 if (tree->read_fn == NULL) {
4950 mpack_log("tree has no read function!\n");
4951 mpack_tree_flag_error(tree, mpack_error_invalid);
4952 return false;
4953 }
4954
4955 // expand the buffer if needed
4956 if (tree->data_length + bytes > tree->buffer_capacity) {
4957
4958 // TODO: check for overflow?
4959 size_t new_capacity = (tree->buffer_capacity == 0) ? MPACK_BUFFER_SIZE : tree->buffer_capacity;
4960 while (new_capacity < tree->data_length + bytes)
4961 new_capacity *= 2;
4962 if (new_capacity > tree->max_size)
4963 new_capacity = tree->max_size;
4964
4965 mpack_log("expanding buffer from %i to %i\n", (int)tree->buffer_capacity, (int)new_capacity);
4966
4967 char* new_buffer;
4968 if (tree->buffer == NULL)
4969 new_buffer = (char*)MPACK_MALLOC(new_capacity);
4970 else
4971 new_buffer = (char*)mpack_realloc(tree->buffer, tree->data_length, new_capacity);
4972
4973 if (new_buffer == NULL) {
4974 mpack_tree_flag_error(tree, mpack_error_memory);
4975 return false;
4976 }
4977
4978 tree->data = new_buffer;
4979 tree->buffer = new_buffer;
4980 tree->buffer_capacity = new_capacity;
4981 }
4982
4983 // request as much data as possible, looping until we have
4984 // all the data we need
4985 do {
4986 size_t read = tree->read_fn(tree, tree->buffer + tree->data_length, tree->buffer_capacity - tree->data_length);
4987
4988 // If the fill function encounters an error, it should flag an error on
4989 // the tree.
4990 if (mpack_tree_error(tree) != mpack_ok)
4991 return false;
4992
4993 // We guard against fill functions that return -1 just in case.
4994 if (read == (size_t)(-1)) {
4995 mpack_tree_flag_error(tree, mpack_error_io);
4996 return false;
4997 }
4998
4999 // If the fill function returns 0, the data is not available yet. We
5000 // return false to stop parsing the current node.
5001 if (read == 0) {
5002 mpack_log("not enough data.\n");
5003 return false;
5004 }
5005
5006 mpack_log("read %u more bytes\n", (uint32_t)read);
5007 tree->data_length += read;
5008 tree->parser.possible_nodes_left += read;
5009 } while (tree->parser.possible_nodes_left < bytes);
5010
5011 return true;
5012}
5013#endif
5014
5015/*
5016 * Ensures there are enough additional bytes in the tree for the current node
5017 * (including reserved bytes for the children of this node, and in addition to
5018 * the reserved bytes for children of previous compound nodes), reading more
5019 * data if needed.
5020 *
5021 * extra_bytes is the number of additional bytes to reserve for the current
5022 * node beyond the type byte (since one byte is already reserved for each node
5023 * by its parent array or map.)
5024 *
5025 * This may reallocate the tree, which means the tree->data pointer may change!
5026 *
5027 * Returns false if not enough bytes could be read.
5028 */
5029MPACK_STATIC_INLINE bool mpack_tree_reserve_bytes(mpack_tree_t* tree, size_t extra_bytes) {
5030 mpack_assert(tree->parser.state == mpack_tree_parse_state_in_progress);
5031
5032 // We guard against overflow here. A compound type could declare more than
5033 // MPACK_UINT32_MAX contents which overflows SIZE_MAX on 32-bit platforms. We
5034 // flag mpack_error_invalid instead of mpack_error_too_big since it's far
5035 // more likely that the message is corrupt than that the data is valid but
5036 // not parseable on this architecture (see test_read_node_possible() in
5037 // test-node.c .)
5038 if ((uint64_t)tree->parser.current_node_reserved + (uint64_t)extra_bytes > SIZE_MAX) {
5039 mpack_tree_flag_error(tree, mpack_error_invalid);
5040 return false;
5041 }
5042
5043 tree->parser.current_node_reserved += extra_bytes;
5044
5045 // Note that possible_nodes_left already accounts for reserved bytes for
5046 // children of previous compound nodes. So even if there are hundreds of
5047 // bytes left in the buffer, we might need to read anyway.
5048 if (tree->parser.current_node_reserved <= tree->parser.possible_nodes_left)
5049 return true;
5050
5051 #ifdef MPACK_MALLOC
5052 return mpack_tree_reserve_fill(tree);
5053 #else
5054 return false;
5055 #endif
5056}
5057
5058MPACK_STATIC_INLINE size_t mpack_tree_parser_stack_capacity(mpack_tree_t* tree) {
5059 #ifdef MPACK_MALLOC
5060 return tree->parser.stack_capacity;
5061 #else
5062 return sizeof(tree->parser.stack) / sizeof(tree->parser.stack[0]);
5063 #endif
5064}
5065
5066static bool mpack_tree_push_stack(mpack_tree_t* tree, mpack_node_data_t* first_child, size_t total) {
5067 mpack_tree_parser_t* parser = &tree->parser;
5068 mpack_assert(parser->state == mpack_tree_parse_state_in_progress);
5069
5070 // No need to push empty containers
5071 if (total == 0)
5072 return true;
5073
5074 // Make sure we have enough room in the stack
5075 if (parser->level + 1 == mpack_tree_parser_stack_capacity(tree)) {
5076 #ifdef MPACK_MALLOC
5077 size_t new_capacity = parser->stack_capacity * 2;
5078 mpack_log("growing parse stack to capacity %i\n", (int)new_capacity);
5079
5080 // Replace the stack-allocated parsing stack
5081 if (!parser->stack_owned) {
5082 mpack_level_t* new_stack = (mpack_level_t*)MPACK_MALLOC(sizeof(mpack_level_t) * new_capacity);
5083 if (!new_stack) {
5084 mpack_tree_flag_error(tree, mpack_error_memory);
5085 return false;
5086 }
5087 mpack_memcpy(new_stack, parser->stack, sizeof(mpack_level_t) * parser->stack_capacity);
5088 parser->stack = new_stack;
5089 parser->stack_owned = true;
5090
5091 // Realloc the allocated parsing stack
5092 } else {
5093 mpack_level_t* new_stack = (mpack_level_t*)mpack_realloc(parser->stack,
5094 sizeof(mpack_level_t) * parser->stack_capacity, sizeof(mpack_level_t) * new_capacity);
5095 if (!new_stack) {
5096 mpack_tree_flag_error(tree, mpack_error_memory);
5097 return false;
5098 }
5099 parser->stack = new_stack;
5100 }
5101 parser->stack_capacity = new_capacity;
5102 #else
5103 mpack_tree_flag_error(tree, mpack_error_too_big);
5104 return false;
5105 #endif
5106 }
5107
5108 // Push the contents of this node onto the parsing stack
5109 ++parser->level;
5110 parser->stack[parser->level].child = first_child;
5111 parser->stack[parser->level].left = total;
5112 return true;
5113}
5114
5115static bool mpack_tree_parse_children(mpack_tree_t* tree, mpack_node_data_t* node) {
5116 mpack_tree_parser_t* parser = &tree->parser;
5117 mpack_assert(parser->state == mpack_tree_parse_state_in_progress);
5118
5119 mpack_type_t type = node->type;
5120 size_t total = node->len;
5121
5122 // Calculate total elements to read
5123 if (type == mpack_type_map) {
5124 if ((uint64_t)total * 2 > SIZE_MAX) {
5125 mpack_tree_flag_error(tree, mpack_error_too_big);
5126 return false;
5127 }
5128 total *= 2;
5129 }
5130
5131 // Make sure we are under our total node limit (TODO can this overflow?)
5132 tree->node_count += total;
5133 if (tree->node_count > tree->max_nodes) {
5134 mpack_tree_flag_error(tree, mpack_error_too_big);
5135 return false;
5136 }
5137
5138 // Each node is at least one byte. Count these bytes now to make
5139 // sure there is enough data left.
5140 if (!mpack_tree_reserve_bytes(tree, total))
5141 return false;
5142
5143 // If there are enough nodes left in the current page, no need to grow
5144 if (total <= parser->nodes_left) {
5145 node->value.children = parser->nodes;
5146 parser->nodes += total;
5147 parser->nodes_left -= total;
5148
5149 } else {
5150
5151 #ifdef MPACK_MALLOC
5152
5153 // We can't grow if we're using a fixed pool (i.e. we didn't start with a page)
5154 if (!tree->next) {
5155 mpack_tree_flag_error(tree, mpack_error_too_big);
5156 return false;
5157 }
5158
5159 // Otherwise we need to grow, and the node's children need to be contiguous.
5160 // This is a heuristic to decide whether we should waste the remaining space
5161 // in the current page and start a new one, or give the children their
5162 // own page. With a fraction of 1/8, this causes at most 12% additional
5163 // waste. Note that reducing this too much causes less cache coherence and
5164 // more malloc() overhead due to smaller allocations, so there's a tradeoff
5165 // here. This heuristic could use some improvement, especially with custom
5166 // page sizes.
5167
5168 mpack_tree_page_t* page;
5169
5170 if (total > MPACK_NODES_PER_PAGE || parser->nodes_left > MPACK_NODES_PER_PAGE / 8) {
5171 // TODO: this should check for overflow
5172 page = (mpack_tree_page_t*)MPACK_MALLOC(
5173 sizeof(mpack_tree_page_t) + sizeof(mpack_node_data_t) * (total - 1));
5174 if (page == NULL) {
5175 mpack_tree_flag_error(tree, mpack_error_memory);
5176 return false;
5177 }
5178 mpack_log("allocated seperate page %p for %i children, %i left in page of %i total\n",
5179 (void*)page, (int)total, (int)parser->nodes_left, (int)MPACK_NODES_PER_PAGE);
5180
5181 node->value.children = page->nodes;
5182
5183 } else {
5184 page = (mpack_tree_page_t*)MPACK_MALLOC(MPACK_PAGE_ALLOC_SIZE);
5185 if (page == NULL) {
5186 mpack_tree_flag_error(tree, mpack_error_memory);
5187 return false;
5188 }
5189 mpack_log("allocated new page %p for %i children, wasting %i in page of %i total\n",
5190 (void*)page, (int)total, (int)parser->nodes_left, (int)MPACK_NODES_PER_PAGE);
5191
5192 node->value.children = page->nodes;
5193 parser->nodes = page->nodes + total;
5194 parser->nodes_left = MPACK_NODES_PER_PAGE - total;
5195 }
5196
5197 page->next = tree->next;
5198 tree->next = page;
5199
5200 #else
5201 // We can't grow if we don't have an allocator
5202 mpack_tree_flag_error(tree, mpack_error_too_big);
5203 return false;
5204 #endif
5205 }
5206
5207 return mpack_tree_push_stack(tree, node->value.children, total);
5208}
5209
5210static bool mpack_tree_parse_bytes(mpack_tree_t* tree, mpack_node_data_t* node) {
5211 node->value.offset = tree->size + tree->parser.current_node_reserved + 1;
5212 return mpack_tree_reserve_bytes(tree, node->len);
5213}
5214
5215#if MPACK_EXTENSIONS
5216static bool mpack_tree_parse_ext(mpack_tree_t* tree, mpack_node_data_t* node) {
5217 // reserve space for exttype
5218 tree->parser.current_node_reserved += sizeof(int8_t);
5219 node->type = mpack_type_ext;
5220 return mpack_tree_parse_bytes(tree, node);
5221}
5222#endif
5223
5224static bool mpack_tree_parse_node_contents(mpack_tree_t* tree, mpack_node_data_t* node) {
5225 mpack_assert(tree->parser.state == mpack_tree_parse_state_in_progress);
5226 mpack_assert(node != NULL, "null node?");
5227
5228 // read the type. we've already accounted for this byte in
5229 // possible_nodes_left, so we already know it is in bounds, and we don't
5230 // need to reserve it for this node.
5231 mpack_assert(tree->data_length > tree->size);
5232 uint8_t type = mpack_load_u8(tree->data + tree->size);
5233 mpack_log("node type %x\n", type);
5234 tree->parser.current_node_reserved = 0;
5235
5236 // as with mpack_read_tag(), the fastest way to parse a node is to switch
5237 // on the first byte, and to explicitly list every possible byte. we switch
5238 // on the first four bits in size-optimized builds.
5239
5240 #if MPACK_OPTIMIZE_FOR_SIZE
5241 switch (type >> 4) {
5242
5243 // positive fixnum
5244 case 0x0: case 0x1: case 0x2: case 0x3:
5245 case 0x4: case 0x5: case 0x6: case 0x7:
5246 node->type = mpack_type_uint;
5247 node->value.u = type;
5248 return true;
5249
5250 // negative fixnum
5251 case 0xe: case 0xf:
5252 node->type = mpack_type_int;
5253 node->value.i = (int8_t)type;
5254 return true;
5255
5256 // fixmap
5257 case 0x8:
5258 node->type = mpack_type_map;
5259 node->len = (uint32_t)(type & ~0xf0);
5260 return mpack_tree_parse_children(tree, node);
5261
5262 // fixarray
5263 case 0x9:
5264 node->type = mpack_type_array;
5265 node->len = (uint32_t)(type & ~0xf0);
5266 return mpack_tree_parse_children(tree, node);
5267
5268 // fixstr
5269 case 0xa: case 0xb:
5270 node->type = mpack_type_str;
5271 node->len = (uint32_t)(type & ~0xe0);
5272 return mpack_tree_parse_bytes(tree, node);
5273
5274 // not one of the common infix types
5275 default:
5276 break;
5277 }
5278 #endif
5279
5280 switch (type) {
5281
5282 #if !MPACK_OPTIMIZE_FOR_SIZE
5283 // positive fixnum
5284 case 0x00: case 0x01: case 0x02: case 0x03: case 0x04: case 0x05: case 0x06: case 0x07:
5285 case 0x08: case 0x09: case 0x0a: case 0x0b: case 0x0c: case 0x0d: case 0x0e: case 0x0f:
5286 case 0x10: case 0x11: case 0x12: case 0x13: case 0x14: case 0x15: case 0x16: case 0x17:
5287 case 0x18: case 0x19: case 0x1a: case 0x1b: case 0x1c: case 0x1d: case 0x1e: case 0x1f:
5288 case 0x20: case 0x21: case 0x22: case 0x23: case 0x24: case 0x25: case 0x26: case 0x27:
5289 case 0x28: case 0x29: case 0x2a: case 0x2b: case 0x2c: case 0x2d: case 0x2e: case 0x2f:
5290 case 0x30: case 0x31: case 0x32: case 0x33: case 0x34: case 0x35: case 0x36: case 0x37:
5291 case 0x38: case 0x39: case 0x3a: case 0x3b: case 0x3c: case 0x3d: case 0x3e: case 0x3f:
5292 case 0x40: case 0x41: case 0x42: case 0x43: case 0x44: case 0x45: case 0x46: case 0x47:
5293 case 0x48: case 0x49: case 0x4a: case 0x4b: case 0x4c: case 0x4d: case 0x4e: case 0x4f:
5294 case 0x50: case 0x51: case 0x52: case 0x53: case 0x54: case 0x55: case 0x56: case 0x57:
5295 case 0x58: case 0x59: case 0x5a: case 0x5b: case 0x5c: case 0x5d: case 0x5e: case 0x5f:
5296 case 0x60: case 0x61: case 0x62: case 0x63: case 0x64: case 0x65: case 0x66: case 0x67:
5297 case 0x68: case 0x69: case 0x6a: case 0x6b: case 0x6c: case 0x6d: case 0x6e: case 0x6f:
5298 case 0x70: case 0x71: case 0x72: case 0x73: case 0x74: case 0x75: case 0x76: case 0x77:
5299 case 0x78: case 0x79: case 0x7a: case 0x7b: case 0x7c: case 0x7d: case 0x7e: case 0x7f:
5300 node->type = mpack_type_uint;
5301 node->value.u = type;
5302 return true;
5303
5304 // negative fixnum
5305 case 0xe0: case 0xe1: case 0xe2: case 0xe3: case 0xe4: case 0xe5: case 0xe6: case 0xe7:
5306 case 0xe8: case 0xe9: case 0xea: case 0xeb: case 0xec: case 0xed: case 0xee: case 0xef:
5307 case 0xf0: case 0xf1: case 0xf2: case 0xf3: case 0xf4: case 0xf5: case 0xf6: case 0xf7:
5308 case 0xf8: case 0xf9: case 0xfa: case 0xfb: case 0xfc: case 0xfd: case 0xfe: case 0xff:
5309 node->type = mpack_type_int;
5310 node->value.i = (int8_t)type;
5311 return true;
5312
5313 // fixmap
5314 case 0x80: case 0x81: case 0x82: case 0x83: case 0x84: case 0x85: case 0x86: case 0x87:
5315 case 0x88: case 0x89: case 0x8a: case 0x8b: case 0x8c: case 0x8d: case 0x8e: case 0x8f:
5316 node->type = mpack_type_map;
5317 node->len = (uint32_t)(type & ~0xf0);
5318 return mpack_tree_parse_children(tree, node);
5319
5320 // fixarray
5321 case 0x90: case 0x91: case 0x92: case 0x93: case 0x94: case 0x95: case 0x96: case 0x97:
5322 case 0x98: case 0x99: case 0x9a: case 0x9b: case 0x9c: case 0x9d: case 0x9e: case 0x9f:
5323 node->type = mpack_type_array;
5324 node->len = (uint32_t)(type & ~0xf0);
5325 return mpack_tree_parse_children(tree, node);
5326
5327 // fixstr
5328 case 0xa0: case 0xa1: case 0xa2: case 0xa3: case 0xa4: case 0xa5: case 0xa6: case 0xa7:
5329 case 0xa8: case 0xa9: case 0xaa: case 0xab: case 0xac: case 0xad: case 0xae: case 0xaf:
5330 case 0xb0: case 0xb1: case 0xb2: case 0xb3: case 0xb4: case 0xb5: case 0xb6: case 0xb7:
5331 case 0xb8: case 0xb9: case 0xba: case 0xbb: case 0xbc: case 0xbd: case 0xbe: case 0xbf:
5332 node->type = mpack_type_str;
5333 node->len = (uint32_t)(type & ~0xe0);
5334 return mpack_tree_parse_bytes(tree, node);
5335 #endif
5336
5337 // nil
5338 case 0xc0:
5339 node->type = mpack_type_nil;
5340 return true;
5341
5342 // bool
5343 case 0xc2: case 0xc3:
5344 node->type = mpack_type_bool;
5345 node->value.b = type & 1;
5346 return true;
5347
5348 // bin8
5349 case 0xc4:
5350 node->type = mpack_type_bin;
5351 if (!mpack_tree_reserve_bytes(tree, sizeof(uint8_t)))
5352 return false;
5353 node->len = mpack_load_u8(tree->data + tree->size + 1);
5354 return mpack_tree_parse_bytes(tree, node);
5355
5356 // bin16
5357 case 0xc5:
5358 node->type = mpack_type_bin;
5359 if (!mpack_tree_reserve_bytes(tree, sizeof(uint16_t)))
5360 return false;
5361 node->len = mpack_load_u16(tree->data + tree->size + 1);
5362 return mpack_tree_parse_bytes(tree, node);
5363
5364 // bin32
5365 case 0xc6:
5366 node->type = mpack_type_bin;
5367 if (!mpack_tree_reserve_bytes(tree, sizeof(uint32_t)))
5368 return false;
5369 node->len = mpack_load_u32(tree->data + tree->size + 1);
5370 return mpack_tree_parse_bytes(tree, node);
5371
5372 #if MPACK_EXTENSIONS
5373 // ext8
5374 case 0xc7:
5375 if (!mpack_tree_reserve_bytes(tree, sizeof(uint8_t)))
5376 return false;
5377 node->len = mpack_load_u8(tree->data + tree->size + 1);
5378 return mpack_tree_parse_ext(tree, node);
5379
5380 // ext16
5381 case 0xc8:
5382 if (!mpack_tree_reserve_bytes(tree, sizeof(uint16_t)))
5383 return false;
5384 node->len = mpack_load_u16(tree->data + tree->size + 1);
5385 return mpack_tree_parse_ext(tree, node);
5386
5387 // ext32
5388 case 0xc9:
5389 if (!mpack_tree_reserve_bytes(tree, sizeof(uint32_t)))
5390 return false;
5391 node->len = mpack_load_u32(tree->data + tree->size + 1);
5392 return mpack_tree_parse_ext(tree, node);
5393 #endif
5394
5395 // float
5396 case 0xca:
5397 #if MPACK_FLOAT
5398 if (!mpack_tree_reserve_bytes(tree, sizeof(float)))
5399 return false;
5400 node->value.f = mpack_load_float(tree->data + tree->size + 1);
5401 #else
5402 if (!mpack_tree_reserve_bytes(tree, sizeof(uint32_t)))
5403 return false;
5404 node->value.f = mpack_load_u32(tree->data + tree->size + 1);
5405 #endif
5406 node->type = mpack_type_float;
5407 return true;
5408
5409 // double
5410 case 0xcb:
5411 #if MPACK_DOUBLE
5412 if (!mpack_tree_reserve_bytes(tree, sizeof(double)))
5413 return false;
5414 node->value.d = mpack_load_double(tree->data + tree->size + 1);
5415 #else
5416 if (!mpack_tree_reserve_bytes(tree, sizeof(uint64_t)))
5417 return false;
5418 node->value.d = mpack_load_u64(tree->data + tree->size + 1);
5419 #endif
5420 node->type = mpack_type_double;
5421 return true;
5422
5423 // uint8
5424 case 0xcc:
5425 node->type = mpack_type_uint;
5426 if (!mpack_tree_reserve_bytes(tree, sizeof(uint8_t)))
5427 return false;
5428 node->value.u = mpack_load_u8(tree->data + tree->size + 1);
5429 return true;
5430
5431 // uint16
5432 case 0xcd:
5433 node->type = mpack_type_uint;
5434 if (!mpack_tree_reserve_bytes(tree, sizeof(uint16_t)))
5435 return false;
5436 node->value.u = mpack_load_u16(tree->data + tree->size + 1);
5437 return true;
5438
5439 // uint32
5440 case 0xce:
5441 node->type = mpack_type_uint;
5442 if (!mpack_tree_reserve_bytes(tree, sizeof(uint32_t)))
5443 return false;
5444 node->value.u = mpack_load_u32(tree->data + tree->size + 1);
5445 return true;
5446
5447 // uint64
5448 case 0xcf:
5449 node->type = mpack_type_uint;
5450 if (!mpack_tree_reserve_bytes(tree, sizeof(uint64_t)))
5451 return false;
5452 node->value.u = mpack_load_u64(tree->data + tree->size + 1);
5453 return true;
5454
5455 // int8
5456 case 0xd0:
5457 node->type = mpack_type_int;
5458 if (!mpack_tree_reserve_bytes(tree, sizeof(int8_t)))
5459 return false;
5460 node->value.i = mpack_load_i8(tree->data + tree->size + 1);
5461 return true;
5462
5463 // int16
5464 case 0xd1:
5465 node->type = mpack_type_int;
5466 if (!mpack_tree_reserve_bytes(tree, sizeof(int16_t)))
5467 return false;
5468 node->value.i = mpack_load_i16(tree->data + tree->size + 1);
5469 return true;
5470
5471 // int32
5472 case 0xd2:
5473 node->type = mpack_type_int;
5474 if (!mpack_tree_reserve_bytes(tree, sizeof(int32_t)))
5475 return false;
5476 node->value.i = mpack_load_i32(tree->data + tree->size + 1);
5477 return true;
5478
5479 // int64
5480 case 0xd3:
5481 node->type = mpack_type_int;
5482 if (!mpack_tree_reserve_bytes(tree, sizeof(int64_t)))
5483 return false;
5484 node->value.i = mpack_load_i64(tree->data + tree->size + 1);
5485 return true;
5486
5487 #if MPACK_EXTENSIONS
5488 // fixext1
5489 case 0xd4:
5490 node->len = 1;
5491 return mpack_tree_parse_ext(tree, node);
5492
5493 // fixext2
5494 case 0xd5:
5495 node->len = 2;
5496 return mpack_tree_parse_ext(tree, node);
5497
5498 // fixext4
5499 case 0xd6:
5500 node->len = 4;
5501 return mpack_tree_parse_ext(tree, node);
5502
5503 // fixext8
5504 case 0xd7:
5505 node->len = 8;
5506 return mpack_tree_parse_ext(tree, node);
5507
5508 // fixext16
5509 case 0xd8:
5510 node->len = 16;
5511 return mpack_tree_parse_ext(tree, node);
5512 #endif
5513
5514 // str8
5515 case 0xd9:
5516 if (!mpack_tree_reserve_bytes(tree, sizeof(uint8_t)))
5517 return false;
5518 node->len = mpack_load_u8(tree->data + tree->size + 1);
5519 node->type = mpack_type_str;
5520 return mpack_tree_parse_bytes(tree, node);
5521
5522 // str16
5523 case 0xda:
5524 if (!mpack_tree_reserve_bytes(tree, sizeof(uint16_t)))
5525 return false;
5526 node->len = mpack_load_u16(tree->data + tree->size + 1);
5527 node->type = mpack_type_str;
5528 return mpack_tree_parse_bytes(tree, node);
5529
5530 // str32
5531 case 0xdb:
5532 if (!mpack_tree_reserve_bytes(tree, sizeof(uint32_t)))
5533 return false;
5534 node->len = mpack_load_u32(tree->data + tree->size + 1);
5535 node->type = mpack_type_str;
5536 return mpack_tree_parse_bytes(tree, node);
5537
5538 // array16
5539 case 0xdc:
5540 if (!mpack_tree_reserve_bytes(tree, sizeof(uint16_t)))
5541 return false;
5542 node->len = mpack_load_u16(tree->data + tree->size + 1);
5543 node->type = mpack_type_array;
5544 return mpack_tree_parse_children(tree, node);
5545
5546 // array32
5547 case 0xdd:
5548 if (!mpack_tree_reserve_bytes(tree, sizeof(uint32_t)))
5549 return false;
5550 node->len = mpack_load_u32(tree->data + tree->size + 1);
5551 node->type = mpack_type_array;
5552 return mpack_tree_parse_children(tree, node);
5553
5554 // map16
5555 case 0xde:
5556 if (!mpack_tree_reserve_bytes(tree, sizeof(uint16_t)))
5557 return false;
5558 node->len = mpack_load_u16(tree->data + tree->size + 1);
5559 node->type = mpack_type_map;
5560 return mpack_tree_parse_children(tree, node);
5561
5562 // map32
5563 case 0xdf:
5564 if (!mpack_tree_reserve_bytes(tree, sizeof(uint32_t)))
5565 return false;
5566 node->len = mpack_load_u32(tree->data + tree->size + 1);
5567 node->type = mpack_type_map;
5568 return mpack_tree_parse_children(tree, node);
5569
5570 // reserved
5571 case 0xc1:
5572 mpack_tree_flag_error(tree, mpack_error_invalid);
5573 return false;
5574
5575 #if !MPACK_EXTENSIONS
5576 // ext
5577 case 0xc7: // fallthrough
5578 case 0xc8: // fallthrough
5579 case 0xc9: // fallthrough
5580 // fixext
5581 case 0xd4: // fallthrough
5582 case 0xd5: // fallthrough
5583 case 0xd6: // fallthrough
5584 case 0xd7: // fallthrough
5585 case 0xd8:
5586 mpack_tree_flag_error(tree, mpack_error_unsupported);
5587 return false;
5588 #endif
5589
5590 #if MPACK_OPTIMIZE_FOR_SIZE
5591 // any other bytes should have been handled by the infix switch
5592 default:
5593 break;
5594 #endif
5595 }
5596
5597 mpack_assert(0, "unreachable");
5598 return false;
5599}
5600
5601static bool mpack_tree_parse_node(mpack_tree_t* tree, mpack_node_data_t* node) {
5602 mpack_log("parsing a node at position %i in level %i\n",
5603 (int)tree->size, (int)tree->parser.level);
5604
5605 if (!mpack_tree_parse_node_contents(tree, node)) {
5606 mpack_log("node parsing returned false\n");
5607 return false;
5608 }
5609
5610 tree->parser.possible_nodes_left -= tree->parser.current_node_reserved;
5611
5612 // The reserve for the current node does not include the initial byte
5613 // previously reserved as part of its parent.
5614 size_t node_size = tree->parser.current_node_reserved + 1;
5615
5616 // If the parsed type is a map or array, the reserve includes one byte for
5617 // each child. We want to subtract these out of possible_nodes_left, but
5618 // not out of the current size of the tree.
5619 if (node->type == mpack_type_array)
5620 node_size -= node->len;
5621 else if (node->type == mpack_type_map)
5622 node_size -= node->len * 2;
5623 tree->size += node_size;
5624
5625 mpack_log("parsed a node of type %s of %i bytes and "
5626 "%i additional bytes reserved for children.\n",
5627 mpack_type_to_string(node->type), (int)node_size,
5628 (int)tree->parser.current_node_reserved + 1 - (int)node_size);
5629
5630 return true;
5631}
5632
5633/*
5634 * We read nodes in a loop instead of recursively for maximum performance. The
5635 * stack holds the amount of children left to read in each level of the tree.
5636 * Parsing can pause and resume when more data becomes available.
5637 */
5638static bool mpack_tree_continue_parsing(mpack_tree_t* tree) {
5639 if (mpack_tree_error(tree) != mpack_ok)
5640 return false;
5641
5642 mpack_tree_parser_t* parser = &tree->parser;
5643 mpack_assert(parser->state == mpack_tree_parse_state_in_progress);
5644 mpack_log("parsing tree elements, %i bytes in buffer\n", (int)tree->data_length);
5645
5646 // we loop parsing nodes until the parse stack is empty. we break
5647 // by returning out of the function.
5648 while (true) {
5649 mpack_node_data_t* node = parser->stack[parser->level].child;
5650 size_t level = parser->level;
5651 if (!mpack_tree_parse_node(tree, node))
5652 return false;
5653 --parser->stack[level].left;
5654 ++parser->stack[level].child;
5655
5656 mpack_assert(mpack_tree_error(tree) == mpack_ok,
5657 "mpack_tree_parse_node() should have returned false due to error!");
5658
5659 // pop empty stack levels, exiting the outer loop when the stack is empty.
5660 // (we could tail-optimize containers by pre-emptively popping empty
5661 // stack levels before reading the new element, this way we wouldn't
5662 // have to loop. but we eventually want to use the parse stack to give
5663 // better error messages that contain the location of the error, so
5664 // it needs to be complete.)
5665 while (parser->stack[parser->level].left == 0) {
5666 if (parser->level == 0)
5667 return true;
5668 --parser->level;
5669 }
5670 }
5671}
5672
5673static void mpack_tree_cleanup(mpack_tree_t* tree) {
5674 MPACK_UNUSED(tree);
5675
5676 #ifdef MPACK_MALLOC
5677 if (tree->parser.stack_owned) {
5678 MPACK_FREE(tree->parser.stack);
5679 tree->parser.stack = NULL;
5680 tree->parser.stack_owned = false;
5681 }
5682
5683 mpack_tree_page_t* page = tree->next;
5684 while (page != NULL) {
5685 mpack_tree_page_t* next = page->next;
5686 mpack_log("freeing page %p\n", (void*)page);
5687 MPACK_FREE(page);
5688 page = next;
5689 }
5690 tree->next = NULL;
5691 #endif
5692}
5693
5694static bool mpack_tree_parse_start(mpack_tree_t* tree) {
5695 if (mpack_tree_error(tree) != mpack_ok)
5696 return false;
5697
5698 mpack_tree_parser_t* parser = &tree->parser;
5699 mpack_assert(parser->state != mpack_tree_parse_state_in_progress,
5700 "previous parsing was not finished!");
5701
5702 if (parser->state == mpack_tree_parse_state_parsed)
5703 mpack_tree_cleanup(tree);
5704
5705 mpack_log("starting parse\n");
5706 tree->parser.state = mpack_tree_parse_state_in_progress;
5707 tree->parser.current_node_reserved = 0;
5708
5709 // check if we previously parsed a tree
5710 if (tree->size > 0) {
5711 #ifdef MPACK_MALLOC
5712 // if we're buffered, move the remaining data back to the
5713 // start of the buffer
5714 // TODO: This is not ideal performance-wise. We should only move data
5715 // when we need to call the fill function.
5716 // TODO: We could consider shrinking the buffer here, especially if we
5717 // determine that the fill function is providing less than a quarter of
5718 // the buffer size or if messages take up less than a quarter of the
5719 // buffer size. Maybe this should be configurable.
5720 if (tree->buffer != NULL) {
5721 mpack_memmove(tree->buffer, tree->buffer + tree->size, tree->data_length - tree->size);
5722 }
5723 else
5724 #endif
5725 // otherwise advance past the parsed data
5726 {
5727 tree->data += tree->size;
5728 }
5729 tree->data_length -= tree->size;
5730 tree->size = 0;
5731 tree->node_count = 0;
5732 }
5733
5734 // make sure we have at least one byte available before allocating anything
5735 parser->possible_nodes_left = tree->data_length;
5736 if (!mpack_tree_reserve_bytes(tree, sizeof(uint8_t))) {
5737 tree->parser.state = mpack_tree_parse_state_not_started;
5738 return false;
5739 }
5740 mpack_log("parsing tree at %p starting with byte %x\n", tree->data, (uint8_t)tree->data[0]);
5741 parser->possible_nodes_left -= 1;
5742 tree->node_count = 1;
5743
5744 #ifdef MPACK_MALLOC
5745 parser->stack = parser->stack_local;
5746 parser->stack_owned = false;
5747 parser->stack_capacity = sizeof(parser->stack_local) / sizeof(*parser->stack_local);
5748
5749 if (tree->pool == NULL) {
5750
5751 // allocate first page
5752 mpack_tree_page_t* page = (mpack_tree_page_t*)MPACK_MALLOC(MPACK_PAGE_ALLOC_SIZE);
5753 mpack_log("allocated initial page %p of size %i count %i\n",
5754 (void*)page, (int)MPACK_PAGE_ALLOC_SIZE, (int)MPACK_NODES_PER_PAGE);
5755 if (page == NULL) {
5756 tree->error = mpack_error_memory;
5757 return false;
5758 }
5759 page->next = NULL;
5760 tree->next = page;
5761
5762 parser->nodes = page->nodes;
5763 parser->nodes_left = MPACK_NODES_PER_PAGE;
5764 }
5765 else
5766 #endif
5767 {
5768 // otherwise use the provided pool
5769 mpack_assert(tree->pool != NULL, "no pool provided?");
5770 parser->nodes = tree->pool;
5771 parser->nodes_left = tree->pool_count;
5772 }
5773
5774 tree->root = parser->nodes;
5775 ++parser->nodes;
5776 --parser->nodes_left;
5777
5778 parser->level = 0;
5779 parser->stack[0].child = tree->root;
5780 parser->stack[0].left = 1;
5781
5782 return true;
5783}
5784
5785void mpack_tree_parse(mpack_tree_t* tree) {
5786 if (mpack_tree_error(tree) != mpack_ok)
5787 return;
5788
5789 if (tree->parser.state != mpack_tree_parse_state_in_progress) {
5790 if (!mpack_tree_parse_start(tree)) {
5791 mpack_tree_flag_error(tree, (tree->read_fn == NULL) ?
5792 mpack_error_invalid : mpack_error_io);
5793 return;
5794 }
5795 }
5796
5797 if (!mpack_tree_continue_parsing(tree)) {
5798 if (mpack_tree_error(tree) != mpack_ok)
5799 return;
5800
5801 // We're parsing synchronously on a blocking fill function. If we
5802 // didn't completely finish parsing the tree, it's an error.
5803 mpack_log("tree parsing incomplete. flagging error.\n");
5804 mpack_tree_flag_error(tree, (tree->read_fn == NULL) ?
5805 mpack_error_invalid : mpack_error_io);
5806 return;
5807 }
5808
5809 mpack_assert(mpack_tree_error(tree) == mpack_ok);
5810 mpack_assert(tree->parser.level == 0);
5811 tree->parser.state = mpack_tree_parse_state_parsed;
5812 mpack_log("parsed tree of %i bytes, %i bytes left\n", (int)tree->size, (int)tree->parser.possible_nodes_left);
5813 mpack_log("%i nodes in final page\n", (int)tree->parser.nodes_left);
5814}
5815
5816bool mpack_tree_try_parse(mpack_tree_t* tree) {
5817 if (mpack_tree_error(tree) != mpack_ok)
5818 return false;
5819
5820 if (tree->parser.state != mpack_tree_parse_state_in_progress)
5821 if (!mpack_tree_parse_start(tree))
5822 return false;
5823
5824 if (!mpack_tree_continue_parsing(tree))
5825 return false;
5826
5827 mpack_assert(mpack_tree_error(tree) == mpack_ok);
5828 mpack_assert(tree->parser.level == 0);
5829 tree->parser.state = mpack_tree_parse_state_parsed;
5830 return true;
5831}
5832
5833
5834
5835/*
5836 * Tree functions
5837 */
5838
5839mpack_node_t mpack_tree_root(mpack_tree_t* tree) {
5840 if (mpack_tree_error(tree) != mpack_ok)
5841 return mpack_tree_nil_node(tree);
5842
5843 // We check that a tree was parsed successfully and assert if not. You must
5844 // call mpack_tree_parse() (or mpack_tree_try_parse() with a success
5845 // result) in order to access the root node.
5846 if (tree->parser.state != mpack_tree_parse_state_parsed) {
5847 mpack_break("Tree has not been parsed! "
5848 "Did you call mpack_tree_parse() or mpack_tree_try_parse()?");
5849 mpack_tree_flag_error(tree, mpack_error_bug);
5850 return mpack_tree_nil_node(tree);
5851 }
5852
5853 return mpack_node(tree, tree->root);
5854}
5855
5856static void mpack_tree_init_clear(mpack_tree_t* tree) {
5857 mpack_memset(tree, 0, sizeof(*tree));
5858 tree->nil_node.type = mpack_type_nil;
5859 tree->missing_node.type = mpack_type_missing;
5860 tree->max_size = SIZE_MAX;
5861 tree->max_nodes = SIZE_MAX;
5862}
5863
5864#ifdef MPACK_MALLOC
5865void mpack_tree_init_data(mpack_tree_t* tree, const char* data, size_t length) {
5866 mpack_tree_init_clear(tree);
5867
5868 MPACK_STATIC_ASSERT(MPACK_NODE_PAGE_SIZE >= sizeof(mpack_tree_page_t),
5869 "MPACK_NODE_PAGE_SIZE is too small");
5870
5871 MPACK_STATIC_ASSERT(MPACK_PAGE_ALLOC_SIZE <= MPACK_NODE_PAGE_SIZE,
5872 "incorrect page rounding?");
5873
5874 tree->data = data;
5875 tree->data_length = length;
5876 tree->pool = NULL;
5877 tree->pool_count = 0;
5878 tree->next = NULL;
5879
5880 mpack_log("===========================\n");
5881 mpack_log("initializing tree with data of size %i\n", (int)length);
5882}
5883#endif
5884
5885void mpack_tree_init_pool(mpack_tree_t* tree, const char* data, size_t length,
5886 mpack_node_data_t* node_pool, size_t node_pool_count)
5887{
5888 mpack_tree_init_clear(tree);
5889 #ifdef MPACK_MALLOC
5890 tree->next = NULL;
5891 #endif
5892
5893 if (node_pool_count == 0) {
5894 mpack_break("initial page has no nodes!");
5895 mpack_tree_flag_error(tree, mpack_error_bug);
5896 return;
5897 }
5898
5899 tree->data = data;
5900 tree->data_length = length;
5901 tree->pool = node_pool;
5902 tree->pool_count = node_pool_count;
5903
5904 mpack_log("===========================\n");
5905 mpack_log("initializing tree with data of size %i and pool of count %i\n",
5906 (int)length, (int)node_pool_count);
5907}
5908
5909void mpack_tree_init_error(mpack_tree_t* tree, mpack_error_t error) {
5910 mpack_tree_init_clear(tree);
5911 tree->error = error;
5912
5913 mpack_log("===========================\n");
5914 mpack_log("initializing tree error state %i\n", (int)error);
5915}
5916
5917#ifdef MPACK_MALLOC
5918void mpack_tree_init_stream(mpack_tree_t* tree, mpack_tree_read_t read_fn, void* context,
5919 size_t max_message_size, size_t max_message_nodes) {
5920 mpack_tree_init_clear(tree);
5921
5922 tree->read_fn = read_fn;
5923 tree->context = context;
5924
5925 mpack_tree_set_limits(tree, max_message_size, max_message_nodes);
5926 tree->max_size = max_message_size;
5927 tree->max_nodes = max_message_nodes;
5928
5929 mpack_log("===========================\n");
5930 mpack_log("initializing tree with stream, max size %i max nodes %i\n",
5931 (int)max_message_size, (int)max_message_nodes);
5932}
5933#endif
5934
5935void mpack_tree_set_limits(mpack_tree_t* tree, size_t max_message_size, size_t max_message_nodes) {
5936 mpack_assert(max_message_size > 0);
5937 mpack_assert(max_message_nodes > 0);
5938 tree->max_size = max_message_size;
5939 tree->max_nodes = max_message_nodes;
5940}
5941
5942#if MPACK_STDIO
5943typedef struct mpack_file_tree_t {
5944 char* data;
5945 size_t size;
5946 char buffer[MPACK_BUFFER_SIZE];
5947} mpack_file_tree_t;
5948
5949static void mpack_file_tree_teardown(mpack_tree_t* tree) {
5950 mpack_file_tree_t* file_tree = (mpack_file_tree_t*)tree->context;
5951 MPACK_FREE(file_tree->data);
5952 MPACK_FREE(file_tree);
5953}
5954
5955static bool mpack_file_tree_read(mpack_tree_t* tree, mpack_file_tree_t* file_tree, FILE* file, size_t max_bytes) {
5956
5957 // get the file size
5958 errno = 0;
5959 int error = 0;
5960 fseek(file, 0, SEEK_END);
5961 error |= errno;
5962 long size = ftell(file);
5963 error |= errno;
5964 fseek(file, 0, SEEK_SET);
5965 error |= errno;
5966
5967 // check for errors
5968 if (error != 0 || size < 0) {
5969 mpack_tree_init_error(tree, mpack_error_io);
5970 return false;
5971 }
5972 if (size == 0) {
5973 mpack_tree_init_error(tree, mpack_error_invalid);
5974 return false;
5975 }
5976
5977 // make sure the size is less than max_bytes
5978 // (this mess exists to safely convert between long and size_t regardless of their widths)
5979 if (max_bytes != 0 && (((uint64_t)LONG_MAX > (uint64_t)SIZE_MAX && size > (long)SIZE_MAX) || (size_t)size > max_bytes)) {
5980 mpack_tree_init_error(tree, mpack_error_too_big);
5981 return false;
5982 }
5983
5984 // allocate data
5985 file_tree->data = (char*)MPACK_MALLOC((size_t)size);
5986 if (file_tree->data == NULL) {
5987 mpack_tree_init_error(tree, mpack_error_memory);
5988 return false;
5989 }
5990
5991 // read the file
5992 long total = 0;
5993 while (total < size) {
5994 size_t read = fread(file_tree->data + total, 1, (size_t)(size - total), file);
5995 if (read <= 0) {
5996 mpack_tree_init_error(tree, mpack_error_io);
5997 MPACK_FREE(file_tree->data);
5998 return false;
5999 }
6000 total += (long)read;
6001 }
6002
6003 file_tree->size = (size_t)size;
6004 return true;
6005}
6006
6007static bool mpack_tree_file_check_max_bytes(mpack_tree_t* tree, size_t max_bytes) {
6008
6009 // the C STDIO family of file functions use long (e.g. ftell)
6010 if (max_bytes > LONG_MAX) {
6011 mpack_break("max_bytes of %" PRIu64 " is invalid, maximum is LONG_MAX", (uint64_t)max_bytes);
6012 mpack_tree_init_error(tree, mpack_error_bug);
6013 return false;
6014 }
6015
6016 return true;
6017}
6018
6019static void mpack_tree_init_stdfile_noclose(mpack_tree_t* tree, FILE* stdfile, size_t max_bytes) {
6020
6021 // allocate file tree
6022 mpack_file_tree_t* file_tree = (mpack_file_tree_t*) MPACK_MALLOC(sizeof(mpack_file_tree_t));
6023 if (file_tree == NULL) {
6024 mpack_tree_init_error(tree, mpack_error_memory);
6025 return;
6026 }
6027
6028 // read all data
6029 if (!mpack_file_tree_read(tree, file_tree, stdfile, max_bytes)) {
6030 MPACK_FREE(file_tree);
6031 return;
6032 }
6033
6034 mpack_tree_init_data(tree, file_tree->data, file_tree->size);
6035 mpack_tree_set_context(tree, file_tree);
6036 mpack_tree_set_teardown(tree, mpack_file_tree_teardown);
6037}
6038
6039void mpack_tree_init_stdfile(mpack_tree_t* tree, FILE* stdfile, size_t max_bytes, bool close_when_done) {
6040 if (!mpack_tree_file_check_max_bytes(tree, max_bytes))
6041 return;
6042
6043 mpack_tree_init_stdfile_noclose(tree, stdfile, max_bytes);
6044
6045 if (close_when_done)
6046 fclose(stdfile);
6047}
6048
6049void mpack_tree_init_filename(mpack_tree_t* tree, const char* filename, size_t max_bytes) {
6050 if (!mpack_tree_file_check_max_bytes(tree, max_bytes))
6051 return;
6052
6053 // open the file
6054 FILE* file = fopen(filename, "rb");
6055 if (!file) {
6056 mpack_tree_init_error(tree, mpack_error_io);
6057 return;
6058 }
6059
6060 mpack_tree_init_stdfile(tree, file, max_bytes, true);
6061}
6062#endif
6063
6064mpack_error_t mpack_tree_destroy(mpack_tree_t* tree) {
6065 mpack_tree_cleanup(tree);
6066
6067 #ifdef MPACK_MALLOC
6068 if (tree->buffer)
6069 MPACK_FREE(tree->buffer);
6070 #endif
6071
6072 if (tree->teardown)
6073 tree->teardown(tree);
6074 tree->teardown = NULL;
6075
6076 return tree->error;
6077}
6078
6079void mpack_tree_flag_error(mpack_tree_t* tree, mpack_error_t error) {
6080 if (tree->error == mpack_ok) {
6081 mpack_log("tree %p setting error %i: %s\n", (void*)tree, (int)error, mpack_error_to_string(error));
6082 tree->error = error;
6083 if (tree->error_fn)
6084 tree->error_fn(tree, error);
6085 }
6086
6087}
6088
6089
6090
6091/*
6092 * Node misc functions
6093 */
6094
6095void mpack_node_flag_error(mpack_node_t node, mpack_error_t error) {
6096 mpack_tree_flag_error(node.tree, error);
6097}
6098
6099mpack_tag_t mpack_node_tag(mpack_node_t node) {
6100 if (mpack_node_error(node) != mpack_ok)
6101 return mpack_tag_nil();
6102
6103 mpack_tag_t tag = MPACK_TAG_ZERO;
6104
6105 tag.type = node.data->type;
6106 switch (node.data->type) {
6107 case mpack_type_missing:
6108 // If a node is missing, I don't know if it makes sense to ask for
6109 // a tag for it. We'll return a missing tag to match the missing
6110 // node I guess, but attempting to use the tag for anything (like
6111 // writing it for example) will flag mpack_error_bug.
6112 break;
6113 case mpack_type_nil: break;
6114 case mpack_type_bool: tag.v.b = node.data->value.b; break;
6115 case mpack_type_float: tag.v.f = node.data->value.f; break;
6116 case mpack_type_double: tag.v.d = node.data->value.d; break;
6117 case mpack_type_int: tag.v.i = node.data->value.i; break;
6118 case mpack_type_uint: tag.v.u = node.data->value.u; break;
6119
6120 case mpack_type_str: tag.v.l = node.data->len; break;
6121 case mpack_type_bin: tag.v.l = node.data->len; break;
6122
6123 #if MPACK_EXTENSIONS
6124 case mpack_type_ext:
6125 tag.v.l = node.data->len;
6126 tag.exttype = mpack_node_exttype_unchecked(node);
6127 break;
6128 #endif
6129
6130 case mpack_type_array: tag.v.n = node.data->len; break;
6131 case mpack_type_map: tag.v.n = node.data->len; break;
6132
6133 default:
6134 mpack_assert(0, "unrecognized type %i", (int)node.data->type);
6135 break;
6136 }
6137 return tag;
6138}
6139
6140#if MPACK_DEBUG && MPACK_STDIO
6141static void mpack_node_print_element(mpack_node_t node, mpack_print_t* print, size_t depth) {
6142 mpack_node_data_t* data = node.data;
6143 size_t i,j;
6144 switch (data->type) {
6145 case mpack_type_str:
6146 {
6147 mpack_print_append_cstr(print, "\"");
6148 const char* bytes = mpack_node_data_unchecked(node);
6149 for (i = 0; i < data->len; ++i) {
6150 char c = bytes[i];
6151 switch (c) {
6152 case '\n': mpack_print_append_cstr(print, "\\n"); break;
6153 case '\\': mpack_print_append_cstr(print, "\\\\"); break;
6154 case '"': mpack_print_append_cstr(print, "\\\""); break;
6155 default: mpack_print_append(print, &c, 1); break;
6156 }
6157 }
6158 mpack_print_append_cstr(print, "\"");
6159 }
6160 break;
6161
6162 case mpack_type_array:
6163 mpack_print_append_cstr(print, "[\n");
6164 for (i = 0; i < data->len; ++i) {
6165 for (j = 0; j < depth + 1; ++j)
6166 mpack_print_append_cstr(print, " ");
6167 mpack_node_print_element(mpack_node_array_at(node, i), print, depth + 1);
6168 if (i != data->len - 1)
6169 mpack_print_append_cstr(print, ",");
6170 mpack_print_append_cstr(print, "\n");
6171 }
6172 for (i = 0; i < depth; ++i)
6173 mpack_print_append_cstr(print, " ");
6174 mpack_print_append_cstr(print, "]");
6175 break;
6176
6177 case mpack_type_map:
6178 mpack_print_append_cstr(print, "{\n");
6179 for (i = 0; i < data->len; ++i) {
6180 for (j = 0; j < depth + 1; ++j)
6181 mpack_print_append_cstr(print, " ");
6182 mpack_node_print_element(mpack_node_map_key_at(node, i), print, depth + 1);
6183 mpack_print_append_cstr(print, ": ");
6184 mpack_node_print_element(mpack_node_map_value_at(node, i), print, depth + 1);
6185 if (i != data->len - 1)
6186 mpack_print_append_cstr(print, ",");
6187 mpack_print_append_cstr(print, "\n");
6188 }
6189 for (i = 0; i < depth; ++i)
6190 mpack_print_append_cstr(print, " ");
6191 mpack_print_append_cstr(print, "}");
6192 break;
6193
6194 default:
6195 {
6196 const char* prefix = NULL;
6197 size_t prefix_length = 0;
6198 if (mpack_node_type(node) == mpack_type_bin
6199 #if MPACK_EXTENSIONS
6200 || mpack_node_type(node) == mpack_type_ext
6201 #endif
6202 ) {
6203 prefix = mpack_node_data(node);
6204 prefix_length = mpack_node_data_len(node);
6205 }
6206
6207 char buf[256];
6208 mpack_tag_t tag = mpack_node_tag(node);
6209 mpack_tag_debug_pseudo_json(tag, buf, sizeof(buf), prefix, prefix_length);
6210 mpack_print_append_cstr(print, buf);
6211 }
6212 break;
6213 }
6214}
6215
6216void mpack_node_print_to_buffer(mpack_node_t node, char* buffer, size_t buffer_size) {
6217 if (buffer_size == 0) {
6218 mpack_assert(false, "buffer size is zero!");
6219 return;
6220 }
6221
6222 mpack_print_t print;
6223 mpack_memset(&print, 0, sizeof(print));
6224 print.buffer = buffer;
6225 print.size = buffer_size;
6226 mpack_node_print_element(node, &print, 0);
6227 mpack_print_append(&print, "", 1); // null-terminator
6228 mpack_print_flush(&print);
6229
6230 // we always make sure there's a null-terminator at the end of the buffer
6231 // in case we ran out of space.
6232 print.buffer[print.size - 1] = '\0';
6233}
6234
6235void mpack_node_print_to_callback(mpack_node_t node, mpack_print_callback_t callback, void* context) {
6236 char buffer[1024];
6237 mpack_print_t print;
6238 mpack_memset(&print, 0, sizeof(print));
6239 print.buffer = buffer;
6240 print.size = sizeof(buffer);
6241 print.callback = callback;
6242 print.context = context;
6243 mpack_node_print_element(node, &print, 0);
6244 mpack_print_flush(&print);
6245}
6246
6247void mpack_node_print_to_file(mpack_node_t node, FILE* file) {
6248 mpack_assert(file != NULL, "file is NULL");
6249
6250 char buffer[1024];
6251 mpack_print_t print;
6252 mpack_memset(&print, 0, sizeof(print));
6253 print.buffer = buffer;
6254 print.size = sizeof(buffer);
6255 print.callback = &mpack_print_file_callback;
6256 print.context = file;
6257
6258 size_t depth = 2;
6259 size_t i;
6260 for (i = 0; i < depth; ++i)
6261 mpack_print_append_cstr(&print, " ");
6262 mpack_node_print_element(node, &print, depth);
6263 mpack_print_append_cstr(&print, "\n");
6264 mpack_print_flush(&print);
6265}
6266#endif
6267
6268
6269
6270/*
6271 * Node Value Functions
6272 */
6273
6274#if MPACK_EXTENSIONS
6275mpack_timestamp_t mpack_node_timestamp(mpack_node_t node) {
6276 mpack_timestamp_t timestamp = {0, 0};
6277
6278 // we'll let mpack_node_exttype() do most checks
6279 if (mpack_node_exttype(node) != MPACK_EXTTYPE_TIMESTAMP) {
6280 mpack_log("exttype %i\n", mpack_node_exttype(node));
6281 mpack_node_flag_error(node, mpack_error_type);
6282 return timestamp;
6283 }
6284
6285 const char* p = mpack_node_data_unchecked(node);
6286
6287 switch (node.data->len) {
6288 case 4:
6289 timestamp.nanoseconds = 0;
6290 timestamp.seconds = mpack_load_u32(p);
6291 break;
6292
6293 case 8: {
6294 uint64_t value = mpack_load_u64(p);
6295 timestamp.nanoseconds = (uint32_t)(value >> 34);
6296 timestamp.seconds = value & ((MPACK_UINT64_C(1) << 34) - 1);
6297 break;
6298 }
6299
6300 case 12:
6301 timestamp.nanoseconds = mpack_load_u32(p);
6302 timestamp.seconds = mpack_load_i64(p + 4);
6303 break;
6304
6305 default:
6306 mpack_tree_flag_error(node.tree, mpack_error_invalid);
6307 return timestamp;
6308 }
6309
6310 if (timestamp.nanoseconds > MPACK_TIMESTAMP_NANOSECONDS_MAX) {
6311 mpack_tree_flag_error(node.tree, mpack_error_invalid);
6312 mpack_timestamp_t zero = {0, 0};
6313 return zero;
6314 }
6315
6316 return timestamp;
6317}
6318
6319int64_t mpack_node_timestamp_seconds(mpack_node_t node) {
6320 return mpack_node_timestamp(node).seconds;
6321}
6322
6323uint32_t mpack_node_timestamp_nanoseconds(mpack_node_t node) {
6324 return mpack_node_timestamp(node).nanoseconds;
6325}
6326#endif
6327
6328
6329
6330/*
6331 * Node Data Functions
6332 */
6333
6334void mpack_node_check_utf8(mpack_node_t node) {
6335 if (mpack_node_error(node) != mpack_ok)
6336 return;
6337 mpack_node_data_t* data = node.data;
6338 if (data->type != mpack_type_str || !mpack_utf8_check(mpack_node_data_unchecked(node), data->len))
6339 mpack_node_flag_error(node, mpack_error_type);
6340}
6341
6342void mpack_node_check_utf8_cstr(mpack_node_t node) {
6343 if (mpack_node_error(node) != mpack_ok)
6344 return;
6345 mpack_node_data_t* data = node.data;
6346 if (data->type != mpack_type_str || !mpack_utf8_check_no_null(mpack_node_data_unchecked(node), data->len))
6347 mpack_node_flag_error(node, mpack_error_type);
6348}
6349
6350size_t mpack_node_copy_data(mpack_node_t node, char* buffer, size_t bufsize) {
6351 if (mpack_node_error(node) != mpack_ok)
6352 return 0;
6353
6354 mpack_assert(bufsize == 0 || buffer != NULL, "buffer is NULL for maximum of %i bytes", (int)bufsize);
6355
6356 mpack_type_t type = node.data->type;
6357 if (type != mpack_type_str && type != mpack_type_bin
6358 #if MPACK_EXTENSIONS
6359 && type != mpack_type_ext
6360 #endif
6361 ) {
6362 mpack_node_flag_error(node, mpack_error_type);
6363 return 0;
6364 }
6365
6366 if (node.data->len > bufsize) {
6367 mpack_node_flag_error(node, mpack_error_too_big);
6368 return 0;
6369 }
6370
6371 mpack_memcpy(buffer, mpack_node_data_unchecked(node), node.data->len);
6372 return (size_t)node.data->len;
6373}
6374
6375size_t mpack_node_copy_utf8(mpack_node_t node, char* buffer, size_t bufsize) {
6376 if (mpack_node_error(node) != mpack_ok)
6377 return 0;
6378
6379 mpack_assert(bufsize == 0 || buffer != NULL, "buffer is NULL for maximum of %i bytes", (int)bufsize);
6380
6381 mpack_type_t type = node.data->type;
6382 if (type != mpack_type_str) {
6383 mpack_node_flag_error(node, mpack_error_type);
6384 return 0;
6385 }
6386
6387 if (node.data->len > bufsize) {
6388 mpack_node_flag_error(node, mpack_error_too_big);
6389 return 0;
6390 }
6391
6392 if (!mpack_utf8_check(mpack_node_data_unchecked(node), node.data->len)) {
6393 mpack_node_flag_error(node, mpack_error_type);
6394 return 0;
6395 }
6396
6397 mpack_memcpy(buffer, mpack_node_data_unchecked(node), node.data->len);
6398 return (size_t)node.data->len;
6399}
6400
6401void mpack_node_copy_cstr(mpack_node_t node, char* buffer, size_t bufsize) {
6402
6403 // we can't break here because the error isn't recoverable; we
6404 // have to add a null-terminator.
6405 mpack_assert(buffer != NULL, "buffer is NULL");
6406 mpack_assert(bufsize >= 1, "buffer size is zero; you must have room for at least a null-terminator");
6407
6408 if (mpack_node_error(node) != mpack_ok) {
6409 buffer[0] = '\0';
6410 return;
6411 }
6412
6413 if (node.data->type != mpack_type_str) {
6414 buffer[0] = '\0';
6415 mpack_node_flag_error(node, mpack_error_type);
6416 return;
6417 }
6418
6419 if (node.data->len > bufsize - 1) {
6420 buffer[0] = '\0';
6421 mpack_node_flag_error(node, mpack_error_too_big);
6422 return;
6423 }
6424
6425 if (!mpack_str_check_no_null(mpack_node_data_unchecked(node), node.data->len)) {
6426 buffer[0] = '\0';
6427 mpack_node_flag_error(node, mpack_error_type);
6428 return;
6429 }
6430
6431 mpack_memcpy(buffer, mpack_node_data_unchecked(node), node.data->len);
6432 buffer[node.data->len] = '\0';
6433}
6434
6435void mpack_node_copy_utf8_cstr(mpack_node_t node, char* buffer, size_t bufsize) {
6436
6437 // we can't break here because the error isn't recoverable; we
6438 // have to add a null-terminator.
6439 mpack_assert(buffer != NULL, "buffer is NULL");
6440 mpack_assert(bufsize >= 1, "buffer size is zero; you must have room for at least a null-terminator");
6441
6442 if (mpack_node_error(node) != mpack_ok) {
6443 buffer[0] = '\0';
6444 return;
6445 }
6446
6447 if (node.data->type != mpack_type_str) {
6448 buffer[0] = '\0';
6449 mpack_node_flag_error(node, mpack_error_type);
6450 return;
6451 }
6452
6453 if (node.data->len > bufsize - 1) {
6454 buffer[0] = '\0';
6455 mpack_node_flag_error(node, mpack_error_too_big);
6456 return;
6457 }
6458
6459 if (!mpack_utf8_check_no_null(mpack_node_data_unchecked(node), node.data->len)) {
6460 buffer[0] = '\0';
6461 mpack_node_flag_error(node, mpack_error_type);
6462 return;
6463 }
6464
6465 mpack_memcpy(buffer, mpack_node_data_unchecked(node), node.data->len);
6466 buffer[node.data->len] = '\0';
6467}
6468
6469#ifdef MPACK_MALLOC
6470char* mpack_node_data_alloc(mpack_node_t node, size_t maxlen) {
6471 if (mpack_node_error(node) != mpack_ok)
6472 return NULL;
6473
6474 // make sure this is a valid data type
6475 mpack_type_t type = node.data->type;
6476 if (type != mpack_type_str && type != mpack_type_bin
6477 #if MPACK_EXTENSIONS
6478 && type != mpack_type_ext
6479 #endif
6480 ) {
6481 mpack_node_flag_error(node, mpack_error_type);
6482 return NULL;
6483 }
6484
6485 if (node.data->len > maxlen) {
6486 mpack_node_flag_error(node, mpack_error_too_big);
6487 return NULL;
6488 }
6489
6490 char* ret = (char*) MPACK_MALLOC((size_t)node.data->len);
6491 if (ret == NULL) {
6492 mpack_node_flag_error(node, mpack_error_memory);
6493 return NULL;
6494 }
6495
6496 mpack_memcpy(ret, mpack_node_data_unchecked(node), node.data->len);
6497 return ret;
6498}
6499
6500char* mpack_node_cstr_alloc(mpack_node_t node, size_t maxlen) {
6501 if (mpack_node_error(node) != mpack_ok)
6502 return NULL;
6503
6504 // make sure maxlen makes sense
6505 if (maxlen < 1) {
6506 mpack_break("maxlen is zero; you must have room for at least a null-terminator");
6507 mpack_node_flag_error(node, mpack_error_bug);
6508 return NULL;
6509 }
6510
6511 if (node.data->type != mpack_type_str) {
6512 mpack_node_flag_error(node, mpack_error_type);
6513 return NULL;
6514 }
6515
6516 if (node.data->len > maxlen - 1) {
6517 mpack_node_flag_error(node, mpack_error_too_big);
6518 return NULL;
6519 }
6520
6521 if (!mpack_str_check_no_null(mpack_node_data_unchecked(node), node.data->len)) {
6522 mpack_node_flag_error(node, mpack_error_type);
6523 return NULL;
6524 }
6525
6526 char* ret = (char*) MPACK_MALLOC((size_t)(node.data->len + 1));
6527 if (ret == NULL) {
6528 mpack_node_flag_error(node, mpack_error_memory);
6529 return NULL;
6530 }
6531
6532 mpack_memcpy(ret, mpack_node_data_unchecked(node), node.data->len);
6533 ret[node.data->len] = '\0';
6534 return ret;
6535}
6536
6537char* mpack_node_utf8_cstr_alloc(mpack_node_t node, size_t maxlen) {
6538 if (mpack_node_error(node) != mpack_ok)
6539 return NULL;
6540
6541 // make sure maxlen makes sense
6542 if (maxlen < 1) {
6543 mpack_break("maxlen is zero; you must have room for at least a null-terminator");
6544 mpack_node_flag_error(node, mpack_error_bug);
6545 return NULL;
6546 }
6547
6548 if (node.data->type != mpack_type_str) {
6549 mpack_node_flag_error(node, mpack_error_type);
6550 return NULL;
6551 }
6552
6553 if (node.data->len > maxlen - 1) {
6554 mpack_node_flag_error(node, mpack_error_too_big);
6555 return NULL;
6556 }
6557
6558 if (!mpack_utf8_check_no_null(mpack_node_data_unchecked(node), node.data->len)) {
6559 mpack_node_flag_error(node, mpack_error_type);
6560 return NULL;
6561 }
6562
6563 char* ret = (char*) MPACK_MALLOC((size_t)(node.data->len + 1));
6564 if (ret == NULL) {
6565 mpack_node_flag_error(node, mpack_error_memory);
6566 return NULL;
6567 }
6568
6569 mpack_memcpy(ret, mpack_node_data_unchecked(node), node.data->len);
6570 ret[node.data->len] = '\0';
6571 return ret;
6572}
6573#endif
6574
6575
6576/*
6577 * Compound Node Functions
6578 */
6579
6580static mpack_node_data_t* mpack_node_map_int_impl(mpack_node_t node, int64_t num) {
6581 if (mpack_node_error(node) != mpack_ok)
6582 return NULL;
6583
6584 if (node.data->type != mpack_type_map) {
6585 mpack_node_flag_error(node, mpack_error_type);
6586 return NULL;
6587 }
6588
6589 mpack_node_data_t* found = NULL;
6590
6591 size_t i;
6592 for (i = 0; i < node.data->len; ++i) {
6593 mpack_node_data_t* key = mpack_node_child(node, i * 2);
6594
6595 if ((key->type == mpack_type_int && key->value.i == num) ||
6596 (key->type == mpack_type_uint && num >= 0 && key->value.u == (uint64_t)num))
6597 {
6598 if (found) {
6599 mpack_node_flag_error(node, mpack_error_data);
6600 return NULL;
6601 }
6602 found = mpack_node_child(node, i * 2 + 1);
6603 }
6604 }
6605
6606 if (found)
6607 return found;
6608
6609 return NULL;
6610}
6611
6612static mpack_node_data_t* mpack_node_map_uint_impl(mpack_node_t node, uint64_t num) {
6613 if (mpack_node_error(node) != mpack_ok)
6614 return NULL;
6615
6616 if (node.data->type != mpack_type_map) {
6617 mpack_node_flag_error(node, mpack_error_type);
6618 return NULL;
6619 }
6620
6621 mpack_node_data_t* found = NULL;
6622
6623 size_t i;
6624 for (i = 0; i < node.data->len; ++i) {
6625 mpack_node_data_t* key = mpack_node_child(node, i * 2);
6626
6627 if ((key->type == mpack_type_uint && key->value.u == num) ||
6628 (key->type == mpack_type_int && key->value.i >= 0 && (uint64_t)key->value.i == num))
6629 {
6630 if (found) {
6631 mpack_node_flag_error(node, mpack_error_data);
6632 return NULL;
6633 }
6634 found = mpack_node_child(node, i * 2 + 1);
6635 }
6636 }
6637
6638 if (found)
6639 return found;
6640
6641 return NULL;
6642}
6643
6644static mpack_node_data_t* mpack_node_map_str_impl(mpack_node_t node, const char* str, size_t length) {
6645 if (mpack_node_error(node) != mpack_ok)
6646 return NULL;
6647
6648 mpack_assert(length == 0 || str != NULL, "str of length %i is NULL", (int)length);
6649
6650 if (node.data->type != mpack_type_map) {
6651 mpack_node_flag_error(node, mpack_error_type);
6652 return NULL;
6653 }
6654
6655 mpack_tree_t* tree = node.tree;
6656 mpack_node_data_t* found = NULL;
6657
6658 size_t i;
6659 for (i = 0; i < node.data->len; ++i) {
6660 mpack_node_data_t* key = mpack_node_child(node, i * 2);
6661
6662 if (key->type == mpack_type_str && key->len == length &&
6663 mpack_memcmp(str, mpack_node_data_unchecked(mpack_node(tree, key)), length) == 0) {
6664 if (found) {
6665 mpack_node_flag_error(node, mpack_error_data);
6666 return NULL;
6667 }
6668 found = mpack_node_child(node, i * 2 + 1);
6669 }
6670 }
6671
6672 if (found)
6673 return found;
6674
6675 return NULL;
6676}
6677
6678static mpack_node_t mpack_node_wrap_lookup(mpack_tree_t* tree, mpack_node_data_t* data) {
6679 if (!data) {
6680 if (tree->error == mpack_ok)
6681 mpack_tree_flag_error(tree, mpack_error_data);
6682 return mpack_tree_nil_node(tree);
6683 }
6684 return mpack_node(tree, data);
6685}
6686
6687static mpack_node_t mpack_node_wrap_lookup_optional(mpack_tree_t* tree, mpack_node_data_t* data) {
6688 if (!data) {
6689 if (tree->error == mpack_ok)
6690 return mpack_tree_missing_node(tree);
6691 return mpack_tree_nil_node(tree);
6692 }
6693 return mpack_node(tree, data);
6694}
6695
6696mpack_node_t mpack_node_map_int(mpack_node_t node, int64_t num) {
6697 return mpack_node_wrap_lookup(node.tree, mpack_node_map_int_impl(node, num));
6698}
6699
6700mpack_node_t mpack_node_map_int_optional(mpack_node_t node, int64_t num) {
6701 return mpack_node_wrap_lookup_optional(node.tree, mpack_node_map_int_impl(node, num));
6702}
6703
6704mpack_node_t mpack_node_map_uint(mpack_node_t node, uint64_t num) {
6705 return mpack_node_wrap_lookup(node.tree, mpack_node_map_uint_impl(node, num));
6706}
6707
6708mpack_node_t mpack_node_map_uint_optional(mpack_node_t node, uint64_t num) {
6709 return mpack_node_wrap_lookup_optional(node.tree, mpack_node_map_uint_impl(node, num));
6710}
6711
6712mpack_node_t mpack_node_map_str(mpack_node_t node, const char* str, size_t length) {
6713 return mpack_node_wrap_lookup(node.tree, mpack_node_map_str_impl(node, str, length));
6714}
6715
6716mpack_node_t mpack_node_map_str_optional(mpack_node_t node, const char* str, size_t length) {
6717 return mpack_node_wrap_lookup_optional(node.tree, mpack_node_map_str_impl(node, str, length));
6718}
6719
6720mpack_node_t mpack_node_map_cstr(mpack_node_t node, const char* cstr) {
6721 mpack_assert(cstr != NULL, "cstr is NULL");
6722 return mpack_node_map_str(node, cstr, mpack_strlen(cstr));
6723}
6724
6725mpack_node_t mpack_node_map_cstr_optional(mpack_node_t node, const char* cstr) {
6726 mpack_assert(cstr != NULL, "cstr is NULL");
6727 return mpack_node_map_str_optional(node, cstr, mpack_strlen(cstr));
6728}
6729
6730bool mpack_node_map_contains_int(mpack_node_t node, int64_t num) {
6731 return mpack_node_map_int_impl(node, num) != NULL;
6732}
6733
6734bool mpack_node_map_contains_uint(mpack_node_t node, uint64_t num) {
6735 return mpack_node_map_uint_impl(node, num) != NULL;
6736}
6737
6738bool mpack_node_map_contains_str(mpack_node_t node, const char* str, size_t length) {
6739 return mpack_node_map_str_impl(node, str, length) != NULL;
6740}
6741
6742bool mpack_node_map_contains_cstr(mpack_node_t node, const char* cstr) {
6743 mpack_assert(cstr != NULL, "cstr is NULL");
6744 return mpack_node_map_contains_str(node, cstr, mpack_strlen(cstr));
6745}
6746
6747size_t mpack_node_enum_optional(mpack_node_t node, const char* strings[], size_t count) {
6748 if (mpack_node_error(node) != mpack_ok)
6749 return count;
6750
6751 // the value is only recognized if it is a string
6752 if (mpack_node_type(node) != mpack_type_str)
6753 return count;
6754
6755 // fetch the string
6756 const char* key = mpack_node_str(node);
6757 size_t keylen = mpack_node_strlen(node);
6758 mpack_assert(mpack_node_error(node) == mpack_ok, "these should not fail");
6759
6760 // find what key it matches
6761 size_t i;
6762 for (i = 0; i < count; ++i) {
6763 const char* other = strings[i];
6764 size_t otherlen = mpack_strlen(other);
6765 if (keylen == otherlen && mpack_memcmp(key, other, keylen) == 0)
6766 return i;
6767 }
6768
6769 // no matches
6770 return count;
6771}
6772
6773size_t mpack_node_enum(mpack_node_t node, const char* strings[], size_t count) {
6774 size_t value = mpack_node_enum_optional(node, strings, count);
6775 if (value == count)
6776 mpack_node_flag_error(node, mpack_error_type);
6777 return value;
6778}
6779
6780mpack_type_t mpack_node_type(mpack_node_t node) {
6781 if (mpack_node_error(node) != mpack_ok)
6782 return mpack_type_nil;
6783 return node.data->type;
6784}
6785
6786bool mpack_node_is_nil(mpack_node_t node) {
6787 if (mpack_node_error(node) != mpack_ok) {
6788 // All nodes are treated as nil nodes when we are in error.
6789 return true;
6790 }
6791 return node.data->type == mpack_type_nil;
6792}
6793
6794bool mpack_node_is_missing(mpack_node_t node) {
6795 if (mpack_node_error(node) != mpack_ok) {
6796 // errors still return nil nodes, not missing nodes.
6797 return false;
6798 }
6799 return node.data->type == mpack_type_missing;
6800}
6801
6802void mpack_node_nil(mpack_node_t node) {
6803 if (mpack_node_error(node) != mpack_ok)
6804 return;
6805 if (node.data->type != mpack_type_nil)
6806 mpack_node_flag_error(node, mpack_error_type);
6807}
6808
6809void mpack_node_missing(mpack_node_t node) {
6810 if (mpack_node_error(node) != mpack_ok)
6811 return;
6812 if (node.data->type != mpack_type_missing)
6813 mpack_node_flag_error(node, mpack_error_type);
6814}
6815
6816bool mpack_node_bool(mpack_node_t node) {
6817 if (mpack_node_error(node) != mpack_ok)
6818 return false;
6819
6820 if (node.data->type == mpack_type_bool)
6821 return node.data->value.b;
6822
6823 mpack_node_flag_error(node, mpack_error_type);
6824 return false;
6825}
6826
6827void mpack_node_true(mpack_node_t node) {
6828 if (mpack_node_bool(node) != true)
6829 mpack_node_flag_error(node, mpack_error_type);
6830}
6831
6832void mpack_node_false(mpack_node_t node) {
6833 if (mpack_node_bool(node) != false)
6834 mpack_node_flag_error(node, mpack_error_type);
6835}
6836
6837uint8_t mpack_node_u8(mpack_node_t node) {
6838 if (mpack_node_error(node) != mpack_ok)
6839 return 0;
6840
6841 if (node.data->type == mpack_type_uint) {
6842 if (node.data->value.u <= MPACK_UINT8_MAX)
6843 return (uint8_t)node.data->value.u;
6844 } else if (node.data->type == mpack_type_int) {
6845 if (node.data->value.i >= 0 && node.data->value.i <= MPACK_UINT8_MAX)
6846 return (uint8_t)node.data->value.i;
6847 }
6848
6849 mpack_node_flag_error(node, mpack_error_type);
6850 return 0;
6851}
6852
6853int8_t mpack_node_i8(mpack_node_t node) {
6854 if (mpack_node_error(node) != mpack_ok)
6855 return 0;
6856
6857 if (node.data->type == mpack_type_uint) {
6858 if (node.data->value.u <= MPACK_INT8_MAX)
6859 return (int8_t)node.data->value.u;
6860 } else if (node.data->type == mpack_type_int) {
6861 if (node.data->value.i >= MPACK_INT8_MIN && node.data->value.i <= MPACK_INT8_MAX)
6862 return (int8_t)node.data->value.i;
6863 }
6864
6865 mpack_node_flag_error(node, mpack_error_type);
6866 return 0;
6867}
6868
6869uint16_t mpack_node_u16(mpack_node_t node) {
6870 if (mpack_node_error(node) != mpack_ok)
6871 return 0;
6872
6873 if (node.data->type == mpack_type_uint) {
6874 if (node.data->value.u <= MPACK_UINT16_MAX)
6875 return (uint16_t)node.data->value.u;
6876 } else if (node.data->type == mpack_type_int) {
6877 if (node.data->value.i >= 0 && node.data->value.i <= MPACK_UINT16_MAX)
6878 return (uint16_t)node.data->value.i;
6879 }
6880
6881 mpack_node_flag_error(node, mpack_error_type);
6882 return 0;
6883}
6884
6885int16_t mpack_node_i16(mpack_node_t node) {
6886 if (mpack_node_error(node) != mpack_ok)
6887 return 0;
6888
6889 if (node.data->type == mpack_type_uint) {
6890 if (node.data->value.u <= MPACK_INT16_MAX)
6891 return (int16_t)node.data->value.u;
6892 } else if (node.data->type == mpack_type_int) {
6893 if (node.data->value.i >= MPACK_INT16_MIN && node.data->value.i <= MPACK_INT16_MAX)
6894 return (int16_t)node.data->value.i;
6895 }
6896
6897 mpack_node_flag_error(node, mpack_error_type);
6898 return 0;
6899}
6900
6901uint32_t mpack_node_u32(mpack_node_t node) {
6902 if (mpack_node_error(node) != mpack_ok)
6903 return 0;
6904
6905 if (node.data->type == mpack_type_uint) {
6906 if (node.data->value.u <= MPACK_UINT32_MAX)
6907 return (uint32_t)node.data->value.u;
6908 } else if (node.data->type == mpack_type_int) {
6909 if (node.data->value.i >= 0 && node.data->value.i <= MPACK_UINT32_MAX)
6910 return (uint32_t)node.data->value.i;
6911 }
6912
6913 mpack_node_flag_error(node, mpack_error_type);
6914 return 0;
6915}
6916
6917int32_t mpack_node_i32(mpack_node_t node) {
6918 if (mpack_node_error(node) != mpack_ok)
6919 return 0;
6920
6921 if (node.data->type == mpack_type_uint) {
6922 if (node.data->value.u <= MPACK_INT32_MAX)
6923 return (int32_t)node.data->value.u;
6924 } else if (node.data->type == mpack_type_int) {
6925 if (node.data->value.i >= MPACK_INT32_MIN && node.data->value.i <= MPACK_INT32_MAX)
6926 return (int32_t)node.data->value.i;
6927 }
6928
6929 mpack_node_flag_error(node, mpack_error_type);
6930 return 0;
6931}
6932
6933uint64_t mpack_node_u64(mpack_node_t node) {
6934 if (mpack_node_error(node) != mpack_ok)
6935 return 0;
6936
6937 if (node.data->type == mpack_type_uint) {
6938 return node.data->value.u;
6939 } else if (node.data->type == mpack_type_int) {
6940 if (node.data->value.i >= 0)
6941 return (uint64_t)node.data->value.i;
6942 }
6943
6944 mpack_node_flag_error(node, mpack_error_type);
6945 return 0;
6946}
6947
6948int64_t mpack_node_i64(mpack_node_t node) {
6949 if (mpack_node_error(node) != mpack_ok)
6950 return 0;
6951
6952 if (node.data->type == mpack_type_uint) {
6953 if (node.data->value.u <= (uint64_t)MPACK_INT64_MAX)
6954 return (int64_t)node.data->value.u;
6955 } else if (node.data->type == mpack_type_int) {
6956 return node.data->value.i;
6957 }
6958
6959 mpack_node_flag_error(node, mpack_error_type);
6960 return 0;
6961}
6962
6963unsigned int mpack_node_uint(mpack_node_t node) {
6964
6965 // This should be true at compile-time, so this just wraps the 32-bit function.
6966 if (sizeof(unsigned int) == 4)
6967 return (unsigned int)mpack_node_u32(node);
6968
6969 // Otherwise we use u64 and check the range.
6970 uint64_t val = mpack_node_u64(node);
6971 if (val <= MPACK_UINT_MAX)
6972 return (unsigned int)val;
6973
6974 mpack_node_flag_error(node, mpack_error_type);
6975 return 0;
6976}
6977
6978int mpack_node_int(mpack_node_t node) {
6979
6980 // This should be true at compile-time, so this just wraps the 32-bit function.
6981 if (sizeof(int) == 4)
6982 return (int)mpack_node_i32(node);
6983
6984 // Otherwise we use i64 and check the range.
6985 int64_t val = mpack_node_i64(node);
6986 if (val >= MPACK_INT_MIN && val <= MPACK_INT_MAX)
6987 return (int)val;
6988
6989 mpack_node_flag_error(node, mpack_error_type);
6990 return 0;
6991}
6992
6993#if MPACK_FLOAT
6994float mpack_node_float(mpack_node_t node) {
6995 if (mpack_node_error(node) != mpack_ok)
6996 return 0.0f;
6997
6998 if (node.data->type == mpack_type_uint)
6999 return (float)node.data->value.u;
7000 if (node.data->type == mpack_type_int)
7001 return (float)node.data->value.i;
7002 if (node.data->type == mpack_type_float)
7003 return node.data->value.f;
7004
7005 if (node.data->type == mpack_type_double) {
7006 #if MPACK_DOUBLE
7007 return (float)node.data->value.d;
7008 #else
7009 return mpack_shorten_raw_double_to_float(node.data->value.d);
7010 #endif
7011 }
7012
7013 mpack_node_flag_error(node, mpack_error_type);
7014 return 0.0f;
7015}
7016#endif
7017
7018#if MPACK_DOUBLE
7019double mpack_node_double(mpack_node_t node) {
7020 if (mpack_node_error(node) != mpack_ok)
7021 return 0.0;
7022
7023 if (node.data->type == mpack_type_uint)
7024 return (double)node.data->value.u;
7025 else if (node.data->type == mpack_type_int)
7026 return (double)node.data->value.i;
7027 else if (node.data->type == mpack_type_float)
7028 return (double)node.data->value.f;
7029 else if (node.data->type == mpack_type_double)
7030 return node.data->value.d;
7031
7032 mpack_node_flag_error(node, mpack_error_type);
7033 return 0.0;
7034}
7035#endif
7036
7037#if MPACK_FLOAT
7038float mpack_node_float_strict(mpack_node_t node) {
7039 if (mpack_node_error(node) != mpack_ok)
7040 return 0.0f;
7041
7042 if (node.data->type == mpack_type_float)
7043 return node.data->value.f;
7044
7045 mpack_node_flag_error(node, mpack_error_type);
7046 return 0.0f;
7047}
7048#endif
7049
7050#if MPACK_DOUBLE
7051double mpack_node_double_strict(mpack_node_t node) {
7052 if (mpack_node_error(node) != mpack_ok)
7053 return 0.0;
7054
7055 if (node.data->type == mpack_type_float)
7056 return (double)node.data->value.f;
7057 else if (node.data->type == mpack_type_double)
7058 return node.data->value.d;
7059
7060 mpack_node_flag_error(node, mpack_error_type);
7061 return 0.0;
7062}
7063#endif
7064
7065#if !MPACK_FLOAT
7066uint32_t mpack_node_raw_float(mpack_node_t node) {
7067 if (mpack_node_error(node) != mpack_ok)
7068 return 0;
7069
7070 if (node.data->type == mpack_type_float)
7071 return node.data->value.f;
7072
7073 mpack_node_flag_error(node, mpack_error_type);
7074 return 0;
7075}
7076#endif
7077
7078#if !MPACK_DOUBLE
7079uint64_t mpack_node_raw_double(mpack_node_t node) {
7080 if (mpack_node_error(node) != mpack_ok)
7081 return 0;
7082
7083 if (node.data->type == mpack_type_double)
7084 return node.data->value.d;
7085
7086 mpack_node_flag_error(node, mpack_error_type);
7087 return 0;
7088}
7089#endif
7090
7091#if MPACK_EXTENSIONS
7092int8_t mpack_node_exttype(mpack_node_t node) {
7093 if (mpack_node_error(node) != mpack_ok)
7094 return 0;
7095
7096 if (node.data->type == mpack_type_ext)
7097 return mpack_node_exttype_unchecked(node);
7098
7099 mpack_node_flag_error(node, mpack_error_type);
7100 return 0;
7101}
7102#endif
7103
7104uint32_t mpack_node_data_len(mpack_node_t node) {
7105 if (mpack_node_error(node) != mpack_ok)
7106 return 0;
7107
7108 mpack_type_t type = node.data->type;
7109 if (type == mpack_type_str || type == mpack_type_bin
7110 #if MPACK_EXTENSIONS
7111 || type == mpack_type_ext
7112 #endif
7113 )
7114 return (uint32_t)node.data->len;
7115
7116 mpack_node_flag_error(node, mpack_error_type);
7117 return 0;
7118}
7119
7120size_t mpack_node_strlen(mpack_node_t node) {
7121 if (mpack_node_error(node) != mpack_ok)
7122 return 0;
7123
7124 if (node.data->type == mpack_type_str)
7125 return (size_t)node.data->len;
7126
7127 mpack_node_flag_error(node, mpack_error_type);
7128 return 0;
7129}
7130
7131const char* mpack_node_str(mpack_node_t node) {
7132 if (mpack_node_error(node) != mpack_ok)
7133 return NULL;
7134
7135 mpack_type_t type = node.data->type;
7136 if (type == mpack_type_str)
7137 return mpack_node_data_unchecked(node);
7138
7139 mpack_node_flag_error(node, mpack_error_type);
7140 return NULL;
7141}
7142
7143const char* mpack_node_data(mpack_node_t node) {
7144 if (mpack_node_error(node) != mpack_ok)
7145 return NULL;
7146
7147 mpack_type_t type = node.data->type;
7148 if (type == mpack_type_str || type == mpack_type_bin
7149 #if MPACK_EXTENSIONS
7150 || type == mpack_type_ext
7151 #endif
7152 )
7153 return mpack_node_data_unchecked(node);
7154
7155 mpack_node_flag_error(node, mpack_error_type);
7156 return NULL;
7157}
7158
7159const char* mpack_node_bin_data(mpack_node_t node) {
7160 if (mpack_node_error(node) != mpack_ok)
7161 return NULL;
7162
7163 if (node.data->type == mpack_type_bin)
7164 return mpack_node_data_unchecked(node);
7165
7166 mpack_node_flag_error(node, mpack_error_type);
7167 return NULL;
7168}
7169
7170size_t mpack_node_bin_size(mpack_node_t node) {
7171 if (mpack_node_error(node) != mpack_ok)
7172 return 0;
7173
7174 if (node.data->type == mpack_type_bin)
7175 return (size_t)node.data->len;
7176
7177 mpack_node_flag_error(node, mpack_error_type);
7178 return 0;
7179}
7180
7181size_t mpack_node_array_length(mpack_node_t node) {
7182 if (mpack_node_error(node) != mpack_ok)
7183 return 0;
7184
7185 if (node.data->type != mpack_type_array) {
7186 mpack_node_flag_error(node, mpack_error_type);
7187 return 0;
7188 }
7189
7190 return (size_t)node.data->len;
7191}
7192
7193mpack_node_t mpack_node_array_at(mpack_node_t node, size_t index) {
7194 if (mpack_node_error(node) != mpack_ok)
7195 return mpack_tree_nil_node(node.tree);
7196
7197 if (node.data->type != mpack_type_array) {
7198 mpack_node_flag_error(node, mpack_error_type);
7199 return mpack_tree_nil_node(node.tree);
7200 }
7201
7202 if (index >= node.data->len) {
7203 mpack_node_flag_error(node, mpack_error_data);
7204 return mpack_tree_nil_node(node.tree);
7205 }
7206
7207 return mpack_node(node.tree, mpack_node_child(node, index));
7208}
7209
7210size_t mpack_node_map_count(mpack_node_t node) {
7211 if (mpack_node_error(node) != mpack_ok)
7212 return 0;
7213
7214 if (node.data->type != mpack_type_map) {
7215 mpack_node_flag_error(node, mpack_error_type);
7216 return 0;
7217 }
7218
7219 return node.data->len;
7220}
7221
7222// internal node map lookup
7223static mpack_node_t mpack_node_map_at(mpack_node_t node, size_t index, size_t offset) {
7224 if (mpack_node_error(node) != mpack_ok)
7225 return mpack_tree_nil_node(node.tree);
7226
7227 if (node.data->type != mpack_type_map) {
7228 mpack_node_flag_error(node, mpack_error_type);
7229 return mpack_tree_nil_node(node.tree);
7230 }
7231
7232 if (index >= node.data->len) {
7233 mpack_node_flag_error(node, mpack_error_data);
7234 return mpack_tree_nil_node(node.tree);
7235 }
7236
7237 return mpack_node(node.tree, mpack_node_child(node, index * 2 + offset));
7238}
7239
7240mpack_node_t mpack_node_map_key_at(mpack_node_t node, size_t index) {
7241 return mpack_node_map_at(node, index, 0);
7242}
7243
7244mpack_node_t mpack_node_map_value_at(mpack_node_t node, size_t index) {
7245 return mpack_node_map_at(node, index, 1);
7246}
7247
7248#endif
7249
7250} // namespace wpi
7251MPACK_SILENCE_WARNINGS_END