123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545 |
- /**
- * Copyright (c) 2014 - 2020, Nordic Semiconductor ASA
- *
- * All rights reserved.
- *
- * Redistribution and use in source and binary forms, with or without modification,
- * are permitted provided that the following conditions are met:
- *
- * 1. Redistributions of source code must retain the above copyright notice, this
- * list of conditions and the following disclaimer.
- *
- * 2. Redistributions in binary form, except as embedded into a Nordic
- * Semiconductor ASA integrated circuit in a product or a software update for
- * such product, must reproduce the above copyright notice, this list of
- * conditions and the following disclaimer in the documentation and/or other
- * materials provided with the distribution.
- *
- * 3. Neither the name of Nordic Semiconductor ASA nor the names of its
- * contributors may be used to endorse or promote products derived from this
- * software without specific prior written permission.
- *
- * 4. This software, with or without modification, must only be used with a
- * Nordic Semiconductor ASA integrated circuit.
- *
- * 5. Any software provided in binary form under this license must not be reverse
- * engineered, decompiled, modified and/or disassembled.
- *
- * THIS SOFTWARE IS PROVIDED BY NORDIC SEMICONDUCTOR ASA "AS IS" AND ANY EXPRESS
- * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
- * OF MERCHANTABILITY, NONINFRINGEMENT, AND FITNESS FOR A PARTICULAR PURPOSE ARE
- * DISCLAIMED. IN NO EVENT SHALL NORDIC SEMICONDUCTOR ASA OR CONTRIBUTORS BE
- * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
- * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE
- * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
- * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
- * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
- * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- *
- */
- #include "ble_struct_serialization.h"
- #include "ble_gap_struct_serialization.h"
- #include "ble_gatt_struct_serialization.h"
- #include "ble_gatts_struct_serialization.h"
- #include "ble_serialization.h"
- #include "app_util.h"
- #include "ble_types.h"
- #include "ble.h"
- #include "cond_field_serialization.h"
- #include "ser_config.h"
- #include <string.h>
- #if NRF_SD_BLE_API_VERSION > 5
- #ifdef UNIT_TEST
- #include "conn_ble_gap_sec_keys.h"
- #include "app_ble_gap_sec_keys.h"
- bool serialization_connectivity_role = true;
- #elif defined(SER_CONNECTIVITY)
- #include "conn_ble_gap_sec_keys.h"
- #else
- #include "app_ble_gap_sec_keys.h"
- #endif /* UNIT_TEST */
- #endif /* NRF_SD_BLE_API_VERSION > 5 */
- uint32_t ble_uuid_t_enc(void const * const p_void_struct,
- uint8_t * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index)
- {
- SER_STRUCT_ENC_BEGIN(ble_uuid_t);
- SER_PUSH_uint16(&p_struct->uuid);
- SER_PUSH_uint8(&p_struct->type);
- SER_STRUCT_ENC_END;
- }
- uint32_t ble_uuid_t_dec(uint8_t const * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index,
- void * const p_void_struct)
- {
- SER_STRUCT_DEC_BEGIN(ble_uuid_t);
- SER_PULL_uint16(&p_struct->uuid);
- SER_PULL_uint8(&p_struct->type);
- SER_STRUCT_DEC_END;
- }
- uint32_t ble_uuid128_t_enc(void const * const p_void_struct,
- uint8_t * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index)
- {
- SER_STRUCT_ENC_BEGIN(ble_uuid128_t);
- SER_PUSH_uint8array(p_struct->uuid128, sizeof (p_struct->uuid128));
- SER_STRUCT_ENC_END;
- }
- uint32_t ble_uuid128_t_dec(uint8_t const * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index,
- void * const p_void_struct)
- {
- SER_STRUCT_DEC_BEGIN(ble_uuid128_t);
- SER_PULL_uint8array(p_struct->uuid128, sizeof (p_struct->uuid128));
- SER_STRUCT_DEC_END;
- }
- #if defined(NRF_SD_BLE_API_VERSION) && NRF_SD_BLE_API_VERSION < 4
- uint32_t ble_enable_params_t_enc(void const * const p_void_struct,
- uint8_t * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index)
- {
- SER_STRUCT_ENC_BEGIN(ble_enable_params_t);
- SER_PUSH_FIELD(&p_struct->common_enable_params, ble_common_enable_params_t_enc);
- SER_PUSH_FIELD(&p_struct->gap_enable_params, ble_gap_enable_params_t_enc);
- SER_PUSH_FIELD(&p_struct->gatt_enable_params, ble_gatt_enable_params_t_enc);
- SER_PUSH_FIELD(&p_struct->gatts_enable_params, ble_gatts_enable_params_t_enc);
- SER_STRUCT_ENC_END;
- }
- uint32_t ble_enable_params_t_dec(uint8_t const * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index,
- void * const p_void_struct)
- {
- SER_STRUCT_DEC_BEGIN(ble_enable_params_t);
- SER_PULL_FIELD(&p_struct->common_enable_params, ble_common_enable_params_t_dec);
- SER_PULL_FIELD(&p_struct->gap_enable_params, ble_gap_enable_params_t_dec);
- SER_PULL_FIELD(&p_struct->gatt_enable_params, ble_gatt_enable_params_t_dec);
- SER_PULL_FIELD(&p_struct->gatts_enable_params, ble_gatts_enable_params_t_dec);
- SER_STRUCT_DEC_END;
- }
- uint32_t ble_conn_bw_t_enc(void const * const p_void_struct,
- uint8_t * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index)
- {
- SER_STRUCT_ENC_BEGIN(ble_conn_bw_t);
- SER_PUSH_uint8(&p_struct->conn_bw_rx);
- SER_PUSH_uint8(&p_struct->conn_bw_tx);
- SER_STRUCT_ENC_END;
- }
- uint32_t ble_conn_bw_t_dec(uint8_t const * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index,
- void * const p_void_struct)
- {
- SER_STRUCT_DEC_BEGIN(ble_conn_bw_t);
- SER_PULL_uint8(&p_struct->conn_bw_rx);
- SER_PULL_uint8(&p_struct->conn_bw_tx);
- SER_STRUCT_DEC_END;
- }
- uint32_t ble_common_opt_conn_bw_t_enc(void const * const p_void_struct,
- uint8_t * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index)
- {
- SER_STRUCT_ENC_BEGIN(ble_common_opt_conn_bw_t);
- SER_PUSH_uint8(&p_struct->role);
- SER_PUSH_FIELD(&p_struct->conn_bw, ble_conn_bw_t_enc);
- SER_STRUCT_ENC_END;
- }
- uint32_t ble_common_opt_conn_bw_t_dec(uint8_t const * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index,
- void * const p_void_struct)
- {
- SER_STRUCT_DEC_BEGIN(ble_common_opt_conn_bw_t);
- SER_PULL_uint8(&p_struct->role);
- SER_PULL_FIELD(&p_struct->conn_bw, ble_conn_bw_t_dec);
- SER_STRUCT_DEC_END;
- }
- uint32_t ble_conn_bw_count_t_enc(void const * const p_void_struct,
- uint8_t * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index)
- {
- SER_STRUCT_ENC_BEGIN(ble_conn_bw_count_t);
- SER_PUSH_uint8(&p_struct->high_count);
- SER_PUSH_uint8(&p_struct->mid_count);
- SER_PUSH_uint8(&p_struct->low_count);
- SER_STRUCT_DEC_END;
- }
- uint32_t ble_conn_bw_count_t_dec(uint8_t const * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index,
- void * const p_void_struct)
- {
- SER_STRUCT_DEC_BEGIN(ble_conn_bw_count_t);
- SER_PULL_uint8(&p_struct->high_count);
- SER_PULL_uint8(&p_struct->mid_count);
- SER_PULL_uint8(&p_struct->low_count);
- SER_STRUCT_DEC_END;
- }
- uint32_t ble_conn_bw_counts_t_enc(void const * const p_void_struct,
- uint8_t * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index)
- {
- SER_STRUCT_ENC_BEGIN(ble_conn_bw_counts_t);
- SER_PUSH_FIELD(&p_struct->tx_counts, ble_conn_bw_count_t_enc);
- SER_PUSH_FIELD(&p_struct->rx_counts, ble_conn_bw_count_t_enc);
- SER_STRUCT_DEC_END;
- }
- uint32_t ble_conn_bw_counts_t_dec(uint8_t const * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index,
- void * const p_void_struct)
- {
- SER_STRUCT_DEC_BEGIN(ble_conn_bw_counts_t);
- SER_PULL_FIELD(&p_struct->tx_counts, ble_conn_bw_count_t_dec);
- SER_PULL_FIELD(&p_struct->rx_counts, ble_conn_bw_count_t_dec);
- SER_STRUCT_DEC_END;
- }
- uint32_t ble_common_enable_params_t_enc(void const * const p_void_struct,
- uint8_t * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index)
- {
- SER_STRUCT_ENC_BEGIN(ble_common_enable_params_t);
- SER_PUSH_uint16(&p_struct->vs_uuid_count);
- SER_PUSH_COND(p_struct->p_conn_bw_counts, ble_conn_bw_counts_t_enc);
- SER_STRUCT_ENC_END;
- }
- uint32_t ble_common_enable_params_t_dec(uint8_t const * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index,
- void * const p_void_struct)
- {
- SER_STRUCT_DEC_BEGIN(ble_common_enable_params_t);
- SER_PULL_uint16(&p_struct->vs_uuid_count);
- SER_PULL_COND(&p_struct->p_conn_bw_counts, ble_conn_bw_counts_t_dec);
- SER_STRUCT_DEC_END;
- }
- #endif
- uint32_t ble_common_opt_pa_lna_t_enc(void const * const p_void_struct,
- uint8_t * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index)
- {
- SER_STRUCT_ENC_BEGIN(ble_common_opt_pa_lna_t);
- SER_PUSH_FIELD(&p_struct->pa_cfg, ble_pa_lna_cfg_t_enc);
- SER_PUSH_FIELD(&p_struct->lna_cfg, ble_pa_lna_cfg_t_enc);
- SER_PUSH_uint8(&p_struct->ppi_ch_id_set);
- SER_PUSH_uint8(&p_struct->ppi_ch_id_clr);
- SER_PUSH_uint8(&p_struct->gpiote_ch_id);
- SER_STRUCT_ENC_END;
- }
- uint32_t ble_common_opt_pa_lna_t_dec(uint8_t const * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index,
- void * const p_void_struct)
- {
- SER_STRUCT_DEC_BEGIN(ble_common_opt_pa_lna_t);
- SER_PULL_FIELD(&p_struct->pa_cfg, ble_pa_lna_cfg_t_dec);
- SER_PULL_FIELD(&p_struct->lna_cfg, ble_pa_lna_cfg_t_dec);
- SER_PULL_uint8(&p_struct->ppi_ch_id_set);
- SER_PULL_uint8(&p_struct->ppi_ch_id_clr);
- SER_PULL_uint8(&p_struct->gpiote_ch_id);
- SER_STRUCT_DEC_END;
- }
- uint32_t ble_pa_lna_cfg_t_enc(void const * const p_void_struct,
- uint8_t * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index)
- {
- SER_STRUCT_ENC_BEGIN(ble_pa_lna_cfg_t);
- uint8_t ser_data = (p_struct->enable & 0x01)
- | ((p_struct->active_high & 0x01) << 1)
- | ((p_struct->gpio_pin & 0x3F) << 2);
- SER_PUSH_uint8(&ser_data);
- SER_STRUCT_ENC_END;
- }
- uint32_t ble_pa_lna_cfg_t_dec(uint8_t const * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index,
- void * const p_void_struct)
- {
- SER_STRUCT_DEC_BEGIN(ble_pa_lna_cfg_t);
- uint8_t ser_data;
- SER_PULL_uint8(&ser_data);
- p_struct->enable = ser_data & 0x01;
- p_struct->active_high = (ser_data >> 1) & 0x01;
- p_struct->gpio_pin = (ser_data >> 2) & 0x3F;
- SER_STRUCT_DEC_END;
- }
- uint32_t ble_user_mem_block_t_enc(void const * const p_void_struct,
- uint8_t * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index)
- {
- SER_STRUCT_ENC_BEGIN(ble_user_mem_block_t);
- SER_PUSH_uint16(&p_struct->len);
- SER_PUSH_COND(p_struct->p_mem, NULL);
- SER_STRUCT_ENC_END;
- }
- uint32_t ble_user_mem_block_t_dec(uint8_t const * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index,
- void * const p_void_struct)
- {
- SER_STRUCT_DEC_BEGIN(ble_user_mem_block_t);
- SER_PULL_uint16(&p_struct->len);
- SER_PULL_COND(&p_struct->p_mem, NULL);
- SER_STRUCT_DEC_END;
- }
- uint32_t ble_version_t_enc(void const * const p_void_struct,
- uint8_t * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index)
- {
- SER_STRUCT_ENC_BEGIN(ble_version_t);
- SER_PUSH_uint8(&p_struct->version_number);
- SER_PUSH_uint16(&p_struct->company_id);
- SER_PUSH_uint16(&p_struct->subversion_number);
- SER_STRUCT_ENC_END;
- }
- uint32_t ble_version_t_dec(uint8_t const * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index,
- void * const p_void_struct)
- {
- SER_STRUCT_DEC_BEGIN(ble_version_t);
- SER_PULL_uint8(&p_struct->version_number);
- SER_PULL_uint16(&p_struct->company_id);
- SER_PULL_uint16(&p_struct->subversion_number);
- SER_STRUCT_DEC_END;
- }
- #if defined(NRF_SD_BLE_API_VERSION) && NRF_SD_BLE_API_VERSION < 4
- uint32_t ble_evt_data_length_changed_t_enc(void const * const p_void_struct,
- uint8_t * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index)
- {
- SER_STRUCT_ENC_BEGIN(ble_evt_data_length_changed_t);
- SER_PUSH_uint16(&p_struct->max_tx_octets);
- SER_PUSH_uint16(&p_struct->max_tx_time);
- SER_PUSH_uint16(&p_struct->max_rx_octets);
- SER_PUSH_uint16(&p_struct->max_rx_time);
- SER_STRUCT_ENC_END;
- }
- uint32_t ble_evt_data_length_changed_t_dec(uint8_t const * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index,
- void * const p_void_struct)
- {
- SER_STRUCT_DEC_BEGIN(ble_evt_data_length_changed_t);
- SER_PULL_uint16(&p_struct->max_tx_octets);
- SER_PULL_uint16(&p_struct->max_tx_time);
- SER_PULL_uint16(&p_struct->max_rx_octets);
- SER_PULL_uint16(&p_struct->max_rx_time);
- SER_STRUCT_DEC_END;
- }
- #endif
- uint32_t ble_common_opt_conn_evt_ext_t_enc(void const * const p_void_struct,
- uint8_t * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index)
- {
- SER_STRUCT_ENC_BEGIN(ble_common_opt_conn_evt_ext_t);
- uint8_t ser_data = p_struct->enable & 0x01;
- SER_PUSH_uint8(&ser_data);
- SER_STRUCT_ENC_END;
- }
- uint32_t ble_common_opt_conn_evt_ext_t_dec(uint8_t const * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index,
- void * const p_void_struct)
- {
- SER_STRUCT_DEC_BEGIN(ble_common_opt_conn_evt_ext_t);
- uint8_t ser_data;
- SER_PULL_uint8(&ser_data);
- p_struct->enable = ser_data & 0x01;
- SER_STRUCT_DEC_END;
- }
- #if NRF_SD_BLE_API_VERSION >= 4
- uint32_t ble_common_cfg_vs_uuid_t_enc(void const * const p_void_struct,
- uint8_t * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index)
- {
- SER_STRUCT_ENC_BEGIN(ble_common_cfg_vs_uuid_t);
- SER_PUSH_uint8(&p_struct->vs_uuid_count);
- SER_STRUCT_ENC_END;
- }
- uint32_t ble_common_cfg_vs_uuid_t_dec(uint8_t const * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index,
- void * const p_void_struct)
- {
- SER_STRUCT_DEC_BEGIN(ble_common_cfg_vs_uuid_t);
- SER_PULL_uint8(&p_struct->vs_uuid_count);
- SER_STRUCT_DEC_END;
- }
- #endif
- #if defined(NRF_SD_BLE_API_VERSION) && NRF_SD_BLE_API_VERSION > 4
- uint32_t ble_data_t_enc(void const * const p_void_struct,
- uint8_t * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index)
- {
- SER_STRUCT_ENC_BEGIN(ble_data_t);
- int buf_id = 0;
- #if NRF_SD_BLE_API_VERSION > 5
- #ifdef UNIT_TEST
- if (serialization_connectivity_role)
- {
- buf_id = conn_ble_gap_ble_data_buf_free(p_struct->p_data);
- }
- else
- {
- buf_id = app_ble_gap_adv_buf_register(p_struct->p_data);
- SER_ASSERT(buf_id >= 0, NRF_ERROR_NO_MEM);
- }
- #elif defined(SER_CONNECTIVITY)
- buf_id = conn_ble_gap_ble_data_buf_free(p_struct->p_data);
- #else
- buf_id = app_ble_gap_adv_buf_register(p_struct->p_data);
- SER_ASSERT(buf_id >= 0, NRF_ERROR_NO_MEM);
- #endif
- #endif /* NRF_SD_BLE_API_VERSION > 5 */
- SER_PUSH_uint32((uint32_t *)&buf_id);
- SER_PUSH_len16data(p_struct->p_data, p_struct->len);
- SER_STRUCT_ENC_END;
- }
- uint32_t ble_data_t_dec(uint8_t const * const p_buf,
- uint32_t buf_len,
- uint32_t * const p_index,
- void * const p_void_struct)
- {
- SER_STRUCT_DEC_BEGIN(ble_data_t);
- uint32_t buf_id;
- SER_PULL_uint32(&buf_id);
- p_struct->len = SER_MAX_ADV_DATA;
- #if NRF_SD_BLE_API_VERSION > 5
- #ifdef UNIT_TEST
- if (serialization_connectivity_role)
- {
- if (buf_id && (p_struct->p_data == NULL))
- {
- p_struct->p_data = conn_ble_gap_ble_data_buf_alloc(buf_id);
- }
- }
- else
- {
- p_struct->p_data = app_ble_gap_adv_buf_unregister((int)buf_id, true);
- }
- #elif defined(SER_CONNECTIVITY)
- if (buf_id && (p_struct->p_data == NULL))
- {
- p_struct->p_data = conn_ble_gap_ble_data_buf_alloc(buf_id);
- }
- #else
- p_struct->p_data = app_ble_gap_adv_buf_unregister(buf_id, true);
- #endif
- #endif /* NRF_SD_BLE_API_VERSION > 5*/
- SER_PULL_len16data(&p_struct->p_data, &p_struct->len);
- SER_STRUCT_DEC_END;
- }
- #endif
|