Jinu Andrews / nRF51

lib/codecs/src/ble_struct_serialization.c@0:6ba9b94b8997, 2017-02-09 (annotated)

Committer:
jinu
Date:
Thu Feb 09 06:08:17 2017 +0000
Revision:
0:6ba9b94b8997
NRF51 serialization libraries for mDot

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jinu 0:6ba9b94b8997 1 /* Copyright (c) Nordic Semiconductor ASA
jinu 0:6ba9b94b8997 2 * All rights reserved.
jinu 0:6ba9b94b8997 3 *
jinu 0:6ba9b94b8997 4 * Redistribution and use in source and binary forms, with or without modification,
jinu 0:6ba9b94b8997 5 * are permitted provided that the following conditions are met:
jinu 0:6ba9b94b8997 6 *
jinu 0:6ba9b94b8997 7 * 1. Redistributions of source code must retain the above copyright notice, this
jinu 0:6ba9b94b8997 8 * list of conditions and the following disclaimer.
jinu 0:6ba9b94b8997 9 *
jinu 0:6ba9b94b8997 10 * 2. Redistributions in binary form must reproduce the above copyright notice, this
jinu 0:6ba9b94b8997 11 * list of conditions and the following disclaimer in the documentation and/or
jinu 0:6ba9b94b8997 12 * other materials provided with the distribution.
jinu 0:6ba9b94b8997 13 *
jinu 0:6ba9b94b8997 14 * 3. Neither the name of Nordic Semiconductor ASA nor the names of other
jinu 0:6ba9b94b8997 15 * contributors to this software may be used to endorse or promote products
jinu 0:6ba9b94b8997 16 * derived from this software without specific prior written permission.
jinu 0:6ba9b94b8997 17 *
jinu 0:6ba9b94b8997 18 * 4. This software must only be used in a processor manufactured by Nordic
jinu 0:6ba9b94b8997 19 * Semiconductor ASA, or in a processor manufactured by a third party that
jinu 0:6ba9b94b8997 20 * is used in combination with a processor manufactured by Nordic Semiconductor.
jinu 0:6ba9b94b8997 21 *
jinu 0:6ba9b94b8997 22 *
jinu 0:6ba9b94b8997 23 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
jinu 0:6ba9b94b8997 24 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
jinu 0:6ba9b94b8997 25 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
jinu 0:6ba9b94b8997 26 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR
jinu 0:6ba9b94b8997 27 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
jinu 0:6ba9b94b8997 28 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
jinu 0:6ba9b94b8997 29 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
jinu 0:6ba9b94b8997 30 * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
jinu 0:6ba9b94b8997 31 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
jinu 0:6ba9b94b8997 32 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
jinu 0:6ba9b94b8997 33 */
jinu 0:6ba9b94b8997 34
jinu 0:6ba9b94b8997 35 #include "ble_struct_serialization.h"
jinu 0:6ba9b94b8997 36 #include "ble_serialization.h"
jinu 0:6ba9b94b8997 37 #include "app_util.h"
jinu 0:6ba9b94b8997 38 #include "ble_types.h"
jinu 0:6ba9b94b8997 39 #include "ble_l2cap.h"
jinu 0:6ba9b94b8997 40 #include "ble.h"
jinu 0:6ba9b94b8997 41 #include "cond_field_serialization.h"
jinu 0:6ba9b94b8997 42 #include <string.h>
jinu 0:6ba9b94b8997 43
jinu 0:6ba9b94b8997 44
jinu 0:6ba9b94b8997 45 uint32_t ble_uuid_t_enc(void const * const p_void_uuid,
jinu 0:6ba9b94b8997 46 uint8_t * const p_buf,
jinu 0:6ba9b94b8997 47 uint32_t buf_len,
jinu 0:6ba9b94b8997 48 uint32_t * const p_index)
jinu 0:6ba9b94b8997 49 {
jinu 0:6ba9b94b8997 50 ble_uuid_t * p_uuid = (ble_uuid_t *)p_void_uuid;
jinu 0:6ba9b94b8997 51 uint32_t err_code = NRF_SUCCESS;
jinu 0:6ba9b94b8997 52
jinu 0:6ba9b94b8997 53 err_code = uint16_t_enc(&p_uuid->uuid, p_buf, buf_len, p_index);
jinu 0:6ba9b94b8997 54 SER_ASSERT(err_code == NRF_SUCCESS, err_code);
jinu 0:6ba9b94b8997 55
jinu 0:6ba9b94b8997 56 err_code = uint8_t_enc(&p_uuid->type, p_buf, buf_len, p_index);
jinu 0:6ba9b94b8997 57 SER_ASSERT(err_code == NRF_SUCCESS, err_code);
jinu 0:6ba9b94b8997 58
jinu 0:6ba9b94b8997 59 return err_code;
jinu 0:6ba9b94b8997 60 }
jinu 0:6ba9b94b8997 61
jinu 0:6ba9b94b8997 62 uint32_t ble_uuid_t_dec(uint8_t const * const p_buf,
jinu 0:6ba9b94b8997 63 uint32_t buf_len,
jinu 0:6ba9b94b8997 64 uint32_t * const p_index,
jinu 0:6ba9b94b8997 65 void * const p_void_uuid)
jinu 0:6ba9b94b8997 66 {
jinu 0:6ba9b94b8997 67 ble_uuid_t * p_uuid = (ble_uuid_t *)p_void_uuid;
jinu 0:6ba9b94b8997 68
jinu 0:6ba9b94b8997 69 SER_ASSERT_LENGTH_LEQ(3, buf_len - *p_index);
jinu 0:6ba9b94b8997 70 uint16_dec(p_buf, buf_len, p_index, &p_uuid->uuid);
jinu 0:6ba9b94b8997 71 uint8_dec(p_buf, buf_len, p_index, &p_uuid->type);
jinu 0:6ba9b94b8997 72
jinu 0:6ba9b94b8997 73 return NRF_SUCCESS;
jinu 0:6ba9b94b8997 74 }
jinu 0:6ba9b94b8997 75
jinu 0:6ba9b94b8997 76 uint32_t ble_uuid128_t_enc(void const * const p_void_uuid,
jinu 0:6ba9b94b8997 77 uint8_t * const p_buf,
jinu 0:6ba9b94b8997 78 uint32_t buf_len,
jinu 0:6ba9b94b8997 79 uint32_t * const p_index)
jinu 0:6ba9b94b8997 80 {
jinu 0:6ba9b94b8997 81 ble_uuid128_t * p_uuid = (ble_uuid128_t *)p_void_uuid;
jinu 0:6ba9b94b8997 82 uint32_t err_code = NRF_SUCCESS;
jinu 0:6ba9b94b8997 83
jinu 0:6ba9b94b8997 84 SER_ASSERT_LENGTH_LEQ(16, buf_len - *p_index);
jinu 0:6ba9b94b8997 85
jinu 0:6ba9b94b8997 86 memcpy(&p_buf[*p_index], p_uuid->uuid128, sizeof (p_uuid->uuid128));
jinu 0:6ba9b94b8997 87
jinu 0:6ba9b94b8997 88 *p_index += sizeof (p_uuid->uuid128);
jinu 0:6ba9b94b8997 89
jinu 0:6ba9b94b8997 90 return err_code;
jinu 0:6ba9b94b8997 91 }
jinu 0:6ba9b94b8997 92
jinu 0:6ba9b94b8997 93 uint32_t ble_uuid128_t_dec(uint8_t const * const p_buf,
jinu 0:6ba9b94b8997 94 uint32_t buf_len,
jinu 0:6ba9b94b8997 95 uint32_t * const p_index,
jinu 0:6ba9b94b8997 96 void * const p_void_uuid)
jinu 0:6ba9b94b8997 97 {
jinu 0:6ba9b94b8997 98 ble_uuid128_t * p_uuid = (ble_uuid128_t *)p_void_uuid;
jinu 0:6ba9b94b8997 99 uint32_t err_code = NRF_SUCCESS;
jinu 0:6ba9b94b8997 100
jinu 0:6ba9b94b8997 101 SER_ASSERT_LENGTH_LEQ(16, buf_len - *p_index);
jinu 0:6ba9b94b8997 102
jinu 0:6ba9b94b8997 103 memcpy(p_uuid->uuid128, &p_buf[*p_index], sizeof (p_uuid->uuid128));
jinu 0:6ba9b94b8997 104
jinu 0:6ba9b94b8997 105 *p_index += sizeof (p_uuid->uuid128);
jinu 0:6ba9b94b8997 106
jinu 0:6ba9b94b8997 107 return err_code;
jinu 0:6ba9b94b8997 108 }
jinu 0:6ba9b94b8997 109
jinu 0:6ba9b94b8997 110 uint32_t ble_l2cap_header_t_enc(void const * const p_void_header,
jinu 0:6ba9b94b8997 111 uint8_t * const p_buf,
jinu 0:6ba9b94b8997 112 uint32_t buf_len,
jinu 0:6ba9b94b8997 113 uint32_t * const p_index)
jinu 0:6ba9b94b8997 114 {
jinu 0:6ba9b94b8997 115 SER_ASSERT_NOT_NULL(p_buf);
jinu 0:6ba9b94b8997 116 SER_ASSERT_NOT_NULL(p_index);
jinu 0:6ba9b94b8997 117 SER_ASSERT_NOT_NULL(p_void_header);
jinu 0:6ba9b94b8997 118
jinu 0:6ba9b94b8997 119 ble_l2cap_header_t * p_header = (ble_l2cap_header_t *)p_void_header;
jinu 0:6ba9b94b8997 120 uint32_t err_code = NRF_SUCCESS;
jinu 0:6ba9b94b8997 121
jinu 0:6ba9b94b8997 122 err_code = uint16_t_enc(&(p_header->len), p_buf, buf_len, p_index);
jinu 0:6ba9b94b8997 123 SER_ASSERT(err_code == NRF_SUCCESS, err_code);
jinu 0:6ba9b94b8997 124
jinu 0:6ba9b94b8997 125 err_code = uint16_t_enc(&(p_header->cid), p_buf, buf_len, p_index);
jinu 0:6ba9b94b8997 126 SER_ASSERT(err_code == NRF_SUCCESS, err_code);
jinu 0:6ba9b94b8997 127
jinu 0:6ba9b94b8997 128 return err_code;
jinu 0:6ba9b94b8997 129 }
jinu 0:6ba9b94b8997 130
jinu 0:6ba9b94b8997 131 uint32_t ble_l2cap_header_t_dec(uint8_t const * const p_buf,
jinu 0:6ba9b94b8997 132 uint32_t buf_len,
jinu 0:6ba9b94b8997 133 uint32_t * const p_index,
jinu 0:6ba9b94b8997 134 void * const p_void_header)
jinu 0:6ba9b94b8997 135 {
jinu 0:6ba9b94b8997 136 SER_ASSERT_NOT_NULL(p_buf);
jinu 0:6ba9b94b8997 137 SER_ASSERT_NOT_NULL(p_index);
jinu 0:6ba9b94b8997 138 SER_ASSERT_NOT_NULL(p_void_header);
jinu 0:6ba9b94b8997 139
jinu 0:6ba9b94b8997 140 ble_l2cap_header_t * p_header = (ble_l2cap_header_t *)p_void_header;
jinu 0:6ba9b94b8997 141 uint32_t err_code = NRF_SUCCESS;
jinu 0:6ba9b94b8997 142
jinu 0:6ba9b94b8997 143 err_code = uint16_t_dec(p_buf, buf_len, p_index, &(p_header->len));
jinu 0:6ba9b94b8997 144 SER_ASSERT(err_code == NRF_SUCCESS, err_code);
jinu 0:6ba9b94b8997 145
jinu 0:6ba9b94b8997 146 err_code = uint16_t_dec(p_buf, buf_len, p_index, &(p_header->cid));
jinu 0:6ba9b94b8997 147 SER_ASSERT(err_code == NRF_SUCCESS, err_code);
jinu 0:6ba9b94b8997 148
jinu 0:6ba9b94b8997 149 return err_code;
jinu 0:6ba9b94b8997 150 }
jinu 0:6ba9b94b8997 151
jinu 0:6ba9b94b8997 152 uint32_t ble_l2cap_evt_rx_t_enc(void const * const p_void_evt_rx,
jinu 0:6ba9b94b8997 153 uint8_t * const p_buf,
jinu 0:6ba9b94b8997 154 uint32_t buf_len,
jinu 0:6ba9b94b8997 155 uint32_t * const p_index)
jinu 0:6ba9b94b8997 156 {
jinu 0:6ba9b94b8997 157 SER_ASSERT_NOT_NULL(p_buf);
jinu 0:6ba9b94b8997 158 SER_ASSERT_NOT_NULL(p_index);
jinu 0:6ba9b94b8997 159 SER_ASSERT_NOT_NULL(p_void_evt_rx);
jinu 0:6ba9b94b8997 160
jinu 0:6ba9b94b8997 161 ble_l2cap_evt_rx_t * p_evt_rx = (ble_l2cap_evt_rx_t *)p_void_evt_rx;
jinu 0:6ba9b94b8997 162 uint32_t err_code = NRF_SUCCESS;
jinu 0:6ba9b94b8997 163
jinu 0:6ba9b94b8997 164 err_code = ble_l2cap_header_t_enc(&(p_evt_rx->header), p_buf, buf_len, p_index);
jinu 0:6ba9b94b8997 165 SER_ASSERT(err_code == NRF_SUCCESS, err_code);
jinu 0:6ba9b94b8997 166
jinu 0:6ba9b94b8997 167 SER_ASSERT_LENGTH_LEQ(p_evt_rx->header.len, buf_len - *p_index);
jinu 0:6ba9b94b8997 168 memcpy(&p_buf[*p_index], p_evt_rx->data, p_evt_rx->header.len);
jinu 0:6ba9b94b8997 169 *p_index += p_evt_rx->header.len;
jinu 0:6ba9b94b8997 170
jinu 0:6ba9b94b8997 171 return err_code;
jinu 0:6ba9b94b8997 172 }
jinu 0:6ba9b94b8997 173
jinu 0:6ba9b94b8997 174 uint32_t ble_l2cap_evt_rx_t_dec(uint8_t const * const p_buf,
jinu 0:6ba9b94b8997 175 uint32_t buf_len,
jinu 0:6ba9b94b8997 176 uint32_t * const p_index,
jinu 0:6ba9b94b8997 177 uint32_t * const p_struct_len,
jinu 0:6ba9b94b8997 178 void * const p_void_evt_rx)
jinu 0:6ba9b94b8997 179 {
jinu 0:6ba9b94b8997 180 SER_ASSERT_NOT_NULL(p_buf);
jinu 0:6ba9b94b8997 181 SER_ASSERT_NOT_NULL(p_index);
jinu 0:6ba9b94b8997 182 SER_ASSERT_NOT_NULL(p_struct_len);
jinu 0:6ba9b94b8997 183
jinu 0:6ba9b94b8997 184 ble_l2cap_evt_rx_t * p_evt_rx = (ble_l2cap_evt_rx_t *)p_void_evt_rx;
jinu 0:6ba9b94b8997 185 uint32_t err_code = NRF_SUCCESS;
jinu 0:6ba9b94b8997 186
jinu 0:6ba9b94b8997 187 uint32_t total_struct_len = *p_struct_len;
jinu 0:6ba9b94b8997 188
jinu 0:6ba9b94b8997 189 /* Get data length */
jinu 0:6ba9b94b8997 190 uint32_t tmp_index = *p_index;
jinu 0:6ba9b94b8997 191 uint16_t len = 0;
jinu 0:6ba9b94b8997 192
jinu 0:6ba9b94b8997 193 err_code = uint16_t_dec(p_buf, buf_len, &tmp_index, &len);
jinu 0:6ba9b94b8997 194 SER_ASSERT(err_code == NRF_SUCCESS, err_code);
jinu 0:6ba9b94b8997 195
jinu 0:6ba9b94b8997 196 /* Update struct length */
jinu 0:6ba9b94b8997 197 *p_struct_len = offsetof(ble_l2cap_evt_rx_t, data[0]);
jinu 0:6ba9b94b8997 198 *p_struct_len += (uint8_t*)&(p_evt_rx->data[len]) - (uint8_t*)&(p_evt_rx->data[0]);
jinu 0:6ba9b94b8997 199
jinu 0:6ba9b94b8997 200 /* Decode header and copy data */
jinu 0:6ba9b94b8997 201 if (p_void_evt_rx != NULL)
jinu 0:6ba9b94b8997 202 {
jinu 0:6ba9b94b8997 203 SER_ASSERT_LENGTH_LEQ(*p_struct_len, total_struct_len);
jinu 0:6ba9b94b8997 204
jinu 0:6ba9b94b8997 205 err_code = ble_l2cap_header_t_dec(p_buf, buf_len, p_index, &(p_evt_rx->header));
jinu 0:6ba9b94b8997 206 SER_ASSERT(err_code == NRF_SUCCESS, err_code);
jinu 0:6ba9b94b8997 207
jinu 0:6ba9b94b8997 208 SER_ASSERT_LENGTH_LEQ(p_evt_rx->header.len, buf_len - *p_index);
jinu 0:6ba9b94b8997 209 memcpy(p_evt_rx->data, &p_buf[*p_index], p_evt_rx->header.len);
jinu 0:6ba9b94b8997 210 *p_index += p_evt_rx->header.len;
jinu 0:6ba9b94b8997 211 }
jinu 0:6ba9b94b8997 212
jinu 0:6ba9b94b8997 213 return err_code;
jinu 0:6ba9b94b8997 214 }
jinu 0:6ba9b94b8997 215
jinu 0:6ba9b94b8997 216 uint32_t ble_enable_params_t_enc(void const * const p_data,
jinu 0:6ba9b94b8997 217 uint8_t * const p_buf,
jinu 0:6ba9b94b8997 218 uint32_t buf_len,
jinu 0:6ba9b94b8997 219 uint32_t * const p_index)
jinu 0:6ba9b94b8997 220 {
jinu 0:6ba9b94b8997 221 ble_enable_params_t * p_enable_params = (ble_enable_params_t *)p_data;
jinu 0:6ba9b94b8997 222
jinu 0:6ba9b94b8997 223 SER_ASSERT_LENGTH_LEQ(1, buf_len - *p_index);
jinu 0:6ba9b94b8997 224
jinu 0:6ba9b94b8997 225 p_buf[*p_index] = p_enable_params->gatts_enable_params.service_changed;
jinu 0:6ba9b94b8997 226 (*p_index)++;
jinu 0:6ba9b94b8997 227
jinu 0:6ba9b94b8997 228 return NRF_SUCCESS;
jinu 0:6ba9b94b8997 229 }
jinu 0:6ba9b94b8997 230
jinu 0:6ba9b94b8997 231 uint32_t ble_enable_params_t_dec(uint8_t const * const p_buf,
jinu 0:6ba9b94b8997 232 uint32_t buf_len,
jinu 0:6ba9b94b8997 233 uint32_t * const p_index,
jinu 0:6ba9b94b8997 234 void * const p_data)
jinu 0:6ba9b94b8997 235 {
jinu 0:6ba9b94b8997 236 ble_enable_params_t * p_enable_params = (ble_enable_params_t *) p_data;
jinu 0:6ba9b94b8997 237
jinu 0:6ba9b94b8997 238 SER_ASSERT_LENGTH_LEQ(sizeof (ble_enable_params_t), buf_len - *p_index);
jinu 0:6ba9b94b8997 239 p_enable_params->gatts_enable_params.service_changed = p_buf[(*p_index)++];
jinu 0:6ba9b94b8997 240
jinu 0:6ba9b94b8997 241 return NRF_SUCCESS;
jinu 0:6ba9b94b8997 242 }
jinu 0:6ba9b94b8997 243