Qi Yao / LinkNode---test123

test code 123

Dependencies:   mbed

Fork of LinkNode-Test by Qi Yao

nRF51822_Science_Journal/pb_common.c@0:1ad0e04b1bc5, 2016-09-01 (annotated)

Committer:
youkee
Date:
Thu Sep 01 05:14:03 2016 +0000
Revision:
0:1ad0e04b1bc5
change internal time from 1s to 200ms

Who changed what in which revision?

UserRevisionLine numberNew 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