test code 123
Fork of LinkNode-Test by
nRF51822_Science_Journal/pb_common.c@1:b0d4fbbdb244, 2016-10-28 (annotated)
- Committer:
- youkee
- Date:
- Fri Oct 28 13:04:10 2016 +0000
- Revision:
- 1:b0d4fbbdb244
- Parent:
- 0:1ad0e04b1bc5
ghhbfdd
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
youkee | 0:1ad0e04b1bc5 | 1 | /* pb_common.c: Common support functions for pb_encode.c and pb_decode.c. |
youkee | 0:1ad0e04b1bc5 | 2 | * |
youkee | 0:1ad0e04b1bc5 | 3 | * 2014 Petteri Aimonen <jpa@kapsi.fi> |
youkee | 0:1ad0e04b1bc5 | 4 | */ |
youkee | 0:1ad0e04b1bc5 | 5 | |
youkee | 0:1ad0e04b1bc5 | 6 | #include "pb_common.h" |
youkee | 0:1ad0e04b1bc5 | 7 | |
youkee | 0:1ad0e04b1bc5 | 8 | bool pb_field_iter_begin(pb_field_iter_t *iter, const pb_field_t *fields, void *dest_struct) |
youkee | 0:1ad0e04b1bc5 | 9 | { |
youkee | 0:1ad0e04b1bc5 | 10 | iter->start = fields; |
youkee | 0:1ad0e04b1bc5 | 11 | iter->pos = fields; |
youkee | 0:1ad0e04b1bc5 | 12 | iter->required_field_index = 0; |
youkee | 0:1ad0e04b1bc5 | 13 | iter->dest_struct = dest_struct; |
youkee | 0:1ad0e04b1bc5 | 14 | iter->pData = (char*)dest_struct + iter->pos->data_offset; |
youkee | 0:1ad0e04b1bc5 | 15 | iter->pSize = (char*)iter->pData + iter->pos->size_offset; |
youkee | 0:1ad0e04b1bc5 | 16 | |
youkee | 0:1ad0e04b1bc5 | 17 | return (iter->pos->tag != 0); |
youkee | 0:1ad0e04b1bc5 | 18 | } |
youkee | 0:1ad0e04b1bc5 | 19 | |
youkee | 0:1ad0e04b1bc5 | 20 | bool pb_field_iter_next(pb_field_iter_t *iter) |
youkee | 0:1ad0e04b1bc5 | 21 | { |
youkee | 0:1ad0e04b1bc5 | 22 | const pb_field_t *prev_field = iter->pos; |
youkee | 0:1ad0e04b1bc5 | 23 | |
youkee | 0:1ad0e04b1bc5 | 24 | if (prev_field->tag == 0) |
youkee | 0:1ad0e04b1bc5 | 25 | { |
youkee | 0:1ad0e04b1bc5 | 26 | /* Handle empty message types, where the first field is already the terminator. |
youkee | 0:1ad0e04b1bc5 | 27 | * In other cases, the iter->pos never points to the terminator. */ |
youkee | 0:1ad0e04b1bc5 | 28 | return false; |
youkee | 0:1ad0e04b1bc5 | 29 | } |
youkee | 0:1ad0e04b1bc5 | 30 | |
youkee | 0:1ad0e04b1bc5 | 31 | iter->pos++; |
youkee | 0:1ad0e04b1bc5 | 32 | |
youkee | 0:1ad0e04b1bc5 | 33 | if (iter->pos->tag == 0) |
youkee | 0:1ad0e04b1bc5 | 34 | { |
youkee | 0:1ad0e04b1bc5 | 35 | /* Wrapped back to beginning, reinitialize */ |
youkee | 0:1ad0e04b1bc5 | 36 | (void)pb_field_iter_begin(iter, iter->start, iter->dest_struct); |
youkee | 0:1ad0e04b1bc5 | 37 | return false; |
youkee | 0:1ad0e04b1bc5 | 38 | } |
youkee | 0:1ad0e04b1bc5 | 39 | else |
youkee | 0:1ad0e04b1bc5 | 40 | { |
youkee | 0:1ad0e04b1bc5 | 41 | /* Increment the pointers based on previous field size */ |
youkee | 0:1ad0e04b1bc5 | 42 | size_t prev_size = prev_field->data_size; |
youkee | 0:1ad0e04b1bc5 | 43 | |
youkee | 0:1ad0e04b1bc5 | 44 | if (PB_HTYPE(prev_field->type) == PB_HTYPE_ONEOF && |
youkee | 0:1ad0e04b1bc5 | 45 | PB_HTYPE(iter->pos->type) == PB_HTYPE_ONEOF) |
youkee | 0:1ad0e04b1bc5 | 46 | { |
youkee | 0:1ad0e04b1bc5 | 47 | /* Don't advance pointers inside unions */ |
youkee | 0:1ad0e04b1bc5 | 48 | prev_size = 0; |
youkee | 0:1ad0e04b1bc5 | 49 | iter->pData = (char*)iter->pData - prev_field->data_offset; |
youkee | 0:1ad0e04b1bc5 | 50 | } |
youkee | 0:1ad0e04b1bc5 | 51 | else if (PB_ATYPE(prev_field->type) == PB_ATYPE_STATIC && |
youkee | 0:1ad0e04b1bc5 | 52 | PB_HTYPE(prev_field->type) == PB_HTYPE_REPEATED) |
youkee | 0:1ad0e04b1bc5 | 53 | { |
youkee | 0:1ad0e04b1bc5 | 54 | /* In static arrays, the data_size tells the size of a single entry and |
youkee | 0:1ad0e04b1bc5 | 55 | * array_size is the number of entries */ |
youkee | 0:1ad0e04b1bc5 | 56 | prev_size *= prev_field->array_size; |
youkee | 0:1ad0e04b1bc5 | 57 | } |
youkee | 0:1ad0e04b1bc5 | 58 | else if (PB_ATYPE(prev_field->type) == PB_ATYPE_POINTER) |
youkee | 0:1ad0e04b1bc5 | 59 | { |
youkee | 0:1ad0e04b1bc5 | 60 | /* Pointer fields always have a constant size in the main structure. |
youkee | 0:1ad0e04b1bc5 | 61 | * The data_size only applies to the dynamically allocated area. */ |
youkee | 0:1ad0e04b1bc5 | 62 | prev_size = sizeof(void*); |
youkee | 0:1ad0e04b1bc5 | 63 | } |
youkee | 0:1ad0e04b1bc5 | 64 | |
youkee | 0:1ad0e04b1bc5 | 65 | if (PB_HTYPE(prev_field->type) == PB_HTYPE_REQUIRED) |
youkee | 0:1ad0e04b1bc5 | 66 | { |
youkee | 0:1ad0e04b1bc5 | 67 | /* Count the required fields, in order to check their presence in the |
youkee | 0:1ad0e04b1bc5 | 68 | * decoder. */ |
youkee | 0:1ad0e04b1bc5 | 69 | iter->required_field_index++; |
youkee | 0:1ad0e04b1bc5 | 70 | } |
youkee | 0:1ad0e04b1bc5 | 71 | |
youkee | 0:1ad0e04b1bc5 | 72 | iter->pData = (char*)iter->pData + prev_size + iter->pos->data_offset; |
youkee | 0:1ad0e04b1bc5 | 73 | iter->pSize = (char*)iter->pData + iter->pos->size_offset; |
youkee | 0:1ad0e04b1bc5 | 74 | return true; |
youkee | 0:1ad0e04b1bc5 | 75 | } |
youkee | 0:1ad0e04b1bc5 | 76 | } |
youkee | 0:1ad0e04b1bc5 | 77 | |
youkee | 0:1ad0e04b1bc5 | 78 | bool pb_field_iter_find(pb_field_iter_t *iter, uint32_t tag) |
youkee | 0:1ad0e04b1bc5 | 79 | { |
youkee | 0:1ad0e04b1bc5 | 80 | const pb_field_t *start = iter->pos; |
youkee | 0:1ad0e04b1bc5 | 81 | |
youkee | 0:1ad0e04b1bc5 | 82 | do { |
youkee | 0:1ad0e04b1bc5 | 83 | if (iter->pos->tag == tag && |
youkee | 0:1ad0e04b1bc5 | 84 | PB_LTYPE(iter->pos->type) != PB_LTYPE_EXTENSION) |
youkee | 0:1ad0e04b1bc5 | 85 | { |
youkee | 0:1ad0e04b1bc5 | 86 | /* Found the wanted field */ |
youkee | 0:1ad0e04b1bc5 | 87 | return true; |
youkee | 0:1ad0e04b1bc5 | 88 | } |
youkee | 0:1ad0e04b1bc5 | 89 | |
youkee | 0:1ad0e04b1bc5 | 90 | (void)pb_field_iter_next(iter); |
youkee | 0:1ad0e04b1bc5 | 91 | } while (iter->pos != start); |
youkee | 0:1ad0e04b1bc5 | 92 | |
youkee | 0:1ad0e04b1bc5 | 93 | /* Searched all the way back to start, and found nothing. */ |
youkee | 0:1ad0e04b1bc5 | 94 | return false; |
youkee | 0:1ad0e04b1bc5 | 95 | } |
youkee | 0:1ad0e04b1bc5 | 96 |