123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513 |
- /**
- * 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 <stdlib.h>
- #include <string.h>
- #include "ble_app.h"
- #include "ble_serialization.h"
- #include "ble_struct_serialization.h"
- #include "ble_gap_struct_serialization.h"
- #include "ble_gatt_struct_serialization.h"
- #include "ble_gattc_struct_serialization.h"
- #include "ble_gatts_struct_serialization.h"
- #include "ble_l2cap_struct_serialization.h"
- #include "cond_field_serialization.h"
- #include "app_util.h"
- #if defined(NRF_SD_BLE_API_VERSION) && NRF_SD_BLE_API_VERSION < 4
- uint32_t ble_enable_req_enc(ble_enable_params_t * p_ble_enable_params,
- uint8_t * const p_buf,
- uint32_t * const p_buf_len)
- {
- SER_REQ_ENC_BEGIN(SD_BLE_ENABLE);
- SER_PUSH_COND(p_ble_enable_params, ble_enable_params_t_enc);
- SER_REQ_ENC_END;
- }
- #else
- uint32_t ble_enable_req_enc(uint8_t * const p_buf,
- uint32_t * const p_buf_len)
- {
- SER_REQ_ENC_BEGIN(SD_BLE_ENABLE);
- SER_REQ_ENC_END;
- }
- #endif
- uint32_t ble_enable_rsp_dec(uint8_t const * const p_buf,
- uint32_t packet_len,
- uint32_t * const p_result_code)
- {
- SER_RSP_DEC_RESULT_ONLY(SD_BLE_ENABLE);
- }
- uint32_t ble_opt_get_req_enc(uint32_t opt_id,
- ble_opt_t const * const p_opt,
- uint8_t * const p_buf,
- uint32_t * const p_buf_len)
- {
- SER_REQ_ENC_BEGIN(SD_BLE_OPT_GET);
- SER_PUSH_uint32(&opt_id);
- SER_PUSH_COND(p_opt, NULL);
- SER_REQ_ENC_END;
- }
- uint32_t ble_opt_get_rsp_dec(uint8_t const * const p_buf,
- uint32_t packet_len,
- uint32_t * const p_opt_id,
- ble_opt_t * const p_opt,
- uint32_t * const p_result_code)
- {
- SER_RSP_DEC_BEGIN(SD_BLE_OPT_GET);
- SER_PULL_uint32(p_opt_id);
- field_decoder_handler_t fp_decoder = NULL;
- void * p_struct = NULL;
- switch (*p_opt_id)
- {
- #if defined(NRF_SD_BLE_API_VERSION) && NRF_SD_BLE_API_VERSION < 4
- case BLE_COMMON_OPT_CONN_BW:
- fp_decoder = ble_common_opt_conn_bw_t_dec;
- p_struct = &(p_opt->common_opt.conn_bw);
- break;
- #endif
- case BLE_COMMON_OPT_PA_LNA:
- fp_decoder = ble_common_opt_pa_lna_t_dec;
- p_struct = &(p_opt->common_opt.pa_lna);
- break;
- case BLE_COMMON_OPT_CONN_EVT_EXT:
- fp_decoder = ble_common_opt_conn_evt_ext_t_dec;
- p_struct = &(p_opt->common_opt.conn_evt_ext);
- break;
- case BLE_GAP_OPT_CH_MAP:
- fp_decoder = ble_gap_opt_ch_map_t_dec;
- p_struct =&(p_opt->gap_opt.ch_map);
- break;
- case BLE_GAP_OPT_LOCAL_CONN_LATENCY:
- fp_decoder = ble_gap_opt_local_conn_latency_t_dec;
- p_struct = &(p_opt->gap_opt.local_conn_latency);
- break;
- case BLE_GAP_OPT_PASSKEY:
- fp_decoder = ble_gap_opt_passkey_t_dec;
- p_struct = &(p_opt->gap_opt.passkey);
- break;
- case BLE_GAP_OPT_AUTH_PAYLOAD_TIMEOUT:
- fp_decoder = ble_gap_opt_auth_payload_timeout_t_dec;
- p_struct = &(p_opt->gap_opt.auth_payload_timeout);
- break;
- #if defined(NRF_SD_BLE_API_VERSION) && NRF_SD_BLE_API_VERSION < 4
- case BLE_GAP_OPT_EXT_LEN:
- fp_decoder = ble_gap_opt_ext_len_t_dec;
- p_struct = &(p_opt->gap_opt.ext_len);
- break;
- #endif
- #if defined(NRF_SD_BLE_API_VERSION) && NRF_SD_BLE_API_VERSION < 6
- case BLE_GAP_OPT_SCAN_REQ_REPORT:
- fp_decoder = ble_gap_opt_scan_req_report_t_dec;
- p_struct = &(p_opt->gap_opt.scan_req_report);
- break;
- #endif
- #if defined(NRF_SD_BLE_API_VERSION) && NRF_SD_BLE_API_VERSION < 4
- case BLE_GAP_OPT_COMPAT_MODE:
- fp_decoder = ble_gap_opt_compat_mode_t_dec;
- p_struct = &(p_opt->gap_opt.compat_mode);
- break;
- #else
- #ifndef S112
- case BLE_GAP_OPT_COMPAT_MODE_1:
- fp_decoder = ble_gap_opt_compat_mode_1_t_dec;
- p_struct = &(p_opt->gap_opt.compat_mode_1);
- break;
- #endif
- #endif
- #if defined(NRF_SD_BLE_API_VERSION) && NRF_SD_BLE_API_VERSION == 4
- case BLE_GAP_OPT_COMPAT_MODE_2:
- fp_decoder = ble_gap_opt_compat_mode_2_t_dec;
- p_struct = &(p_opt->gap_opt.compat_mode_2);
- break;
- #endif
- default:
- SER_ASSERT(NRF_ERROR_INVALID_PARAM, NRF_ERROR_INVALID_PARAM);
- break;
- }
- SER_PULL_FIELD(p_struct, fp_decoder);
- SER_RSP_DEC_END;
- }
- uint32_t ble_opt_set_req_enc(uint32_t const opt_id,
- ble_opt_t const * const p_opt,
- uint8_t * const p_buf,
- uint32_t * const p_buf_len)
- {
- SER_REQ_ENC_BEGIN(SD_BLE_OPT_SET);
- SER_PUSH_uint32(&opt_id);
- field_encoder_handler_t fp_encoder = NULL;
- void const * p_struct = NULL;
- SER_PUSH_COND(p_opt, NULL);
- if (p_opt)
- {
- switch (opt_id)
- {
- #if defined(NRF_SD_BLE_API_VERSION) && NRF_SD_BLE_API_VERSION < 4
- case BLE_COMMON_OPT_CONN_BW:
- fp_encoder = ble_common_opt_conn_bw_t_enc;
- p_struct = &(p_opt->common_opt.conn_bw);
- break;
- #endif
- case BLE_COMMON_OPT_PA_LNA:
- fp_encoder = ble_common_opt_pa_lna_t_enc;
- p_struct = &(p_opt->common_opt.pa_lna);
- break;
- case BLE_COMMON_OPT_CONN_EVT_EXT:
- fp_encoder = ble_common_opt_conn_evt_ext_t_enc;
- p_struct = &(p_opt->common_opt.conn_evt_ext);
- break;
- case BLE_GAP_OPT_CH_MAP:
- fp_encoder = ble_gap_opt_ch_map_t_enc;
- p_struct = &(p_opt->gap_opt.ch_map);
- break;
- case BLE_GAP_OPT_LOCAL_CONN_LATENCY:
- fp_encoder = ble_gap_opt_local_conn_latency_t_enc;
- p_struct = &(p_opt->gap_opt.local_conn_latency);
- break;
- case BLE_GAP_OPT_PASSKEY:
- fp_encoder = ble_gap_opt_passkey_t_enc;
- p_struct = &(p_opt->gap_opt.passkey);
- break;
- case BLE_GAP_OPT_AUTH_PAYLOAD_TIMEOUT:
- fp_encoder = ble_gap_opt_auth_payload_timeout_t_enc;
- p_struct = &(p_opt->gap_opt.auth_payload_timeout);
- break;
- #if defined(NRF_SD_BLE_API_VERSION) && NRF_SD_BLE_API_VERSION < 4
- case BLE_GAP_OPT_EXT_LEN:
- fp_encoder = ble_gap_opt_ext_len_t_enc;
- p_struct = &(p_opt->gap_opt.ext_len);
- break;
- #endif
- #if defined(NRF_SD_BLE_API_VERSION) && NRF_SD_BLE_API_VERSION < 6
- case BLE_GAP_OPT_SCAN_REQ_REPORT:
- fp_encoder = ble_gap_opt_scan_req_report_t_enc;
- p_struct = &(p_opt->gap_opt.scan_req_report);
- break;
- #endif
- #if defined(NRF_SD_BLE_API_VERSION) && NRF_SD_BLE_API_VERSION < 4
- case BLE_GAP_OPT_COMPAT_MODE:
- fp_encoder = ble_gap_opt_compat_mode_t_enc;
- p_struct = &(p_opt->gap_opt.compat_mode);
- break;
- #else
- #ifndef S112
- case BLE_GAP_OPT_COMPAT_MODE_1:
- fp_encoder = ble_gap_opt_compat_mode_1_t_enc;
- p_struct = &(p_opt->gap_opt.compat_mode_1);
- break;
- #endif
- case BLE_GAP_OPT_SLAVE_LATENCY_DISABLE:
- fp_encoder = ble_gap_opt_slave_latency_disable_t_enc;
- p_struct = &(p_opt->gap_opt.slave_latency_disable);
- break;
- #endif
- #if defined(NRF_SD_BLE_API_VERSION) && NRF_SD_BLE_API_VERSION == 4
- case BLE_GAP_OPT_COMPAT_MODE_2:
- fp_encoder = ble_gap_opt_compat_mode_2_t_enc;
- p_struct = &(p_opt->gap_opt.compat_mode_2);
- break;
- #endif
- default:
- SER_ASSERT(NRF_ERROR_INVALID_PARAM,NRF_ERROR_INVALID_PARAM);
- break;
- }
- SER_PUSH_FIELD(p_struct, fp_encoder);
- }
- SER_REQ_ENC_END;
- }
- uint32_t ble_opt_set_rsp_dec(uint8_t const * const p_buf,
- uint32_t packet_len,
- uint32_t * const p_result_code)
- {
- SER_RSP_DEC_RESULT_ONLY(SD_BLE_OPT_SET);
- }
- #if defined(NRF_SD_BLE_API_VERSION) && NRF_SD_BLE_API_VERSION < 4
- uint32_t ble_tx_packet_count_get_req_enc(uint16_t conn_handle,
- uint8_t const * const p_count,
- uint8_t * const p_buf,
- uint32_t * const p_buf_len)
- {
- SER_REQ_ENC_BEGIN(SD_BLE_TX_PACKET_COUNT_GET);
- SER_PUSH_uint16(&conn_handle);
- SER_PUSH_COND(p_count, NULL);
- SER_REQ_ENC_END;
- }
- uint32_t ble_tx_packet_count_get_rsp_dec(uint8_t const * const p_buf,
- uint32_t packet_len,
- uint8_t * * const pp_count,
- uint32_t * const p_result_code)
- {
- SER_RSP_DEC_BEGIN(SD_BLE_TX_PACKET_COUNT_GET);
- SER_PULL_COND(pp_count, uint8_t_dec);
- SER_RSP_DEC_END;
- }
- #endif
- uint32_t ble_user_mem_reply_req_enc(uint16_t conn_handle,
- ble_user_mem_block_t const * p_block,
- uint8_t * const p_buf,
- uint32_t * const p_buf_len)
- {
- SER_REQ_ENC_BEGIN(SD_BLE_USER_MEM_REPLY);
- SER_PUSH_uint16(&conn_handle);
- SER_PUSH_COND(p_block, ble_user_mem_block_t_enc);
- SER_REQ_ENC_END;
- }
- uint32_t ble_user_mem_reply_rsp_dec(uint8_t const * const p_buf,
- uint32_t packet_len,
- uint32_t * const p_result_code)
- {
- SER_RSP_DEC_RESULT_ONLY(SD_BLE_USER_MEM_REPLY);
- }
- uint32_t ble_uuid_decode_req_enc(uint8_t uuid_le_len,
- uint8_t const * const p_uuid_le,
- ble_uuid_t * const p_uuid,
- uint8_t * const p_buf,
- uint32_t * const p_buf_len)
- {
- SER_REQ_ENC_BEGIN(SD_BLE_UUID_DECODE);
- SER_PUSH_len8data(p_uuid_le, uuid_le_len);
- SER_PUSH_COND(p_uuid, NULL);
- SER_REQ_ENC_END;
- }
- uint32_t ble_uuid_decode_rsp_dec(uint8_t const * const p_buf,
- uint32_t packet_len,
- ble_uuid_t * * const pp_uuid,
- uint32_t * const p_result_code)
- {
- SER_RSP_DEC_BEGIN(SD_BLE_UUID_DECODE);
- SER_PULL_COND(pp_uuid, ble_uuid_t_dec);
- SER_RSP_DEC_END;
- }
- uint32_t ble_uuid_encode_req_enc(ble_uuid_t const * const p_uuid,
- uint8_t const * const p_uuid_le_len,
- uint8_t const * const p_uuid_le,
- uint8_t * const p_buf,
- uint32_t * const p_buf_len)
- {
- SER_REQ_ENC_BEGIN(SD_BLE_UUID_ENCODE);
- SER_PUSH_COND(p_uuid, ble_uuid_t_enc);
- SER_PUSH_COND(p_uuid_le_len, NULL);
- SER_PUSH_COND(p_uuid_le, NULL);
- SER_REQ_ENC_END;
- }
- uint32_t ble_uuid_encode_rsp_dec(uint8_t const * const p_buf,
- uint32_t packet_len,
- uint8_t * const p_uuid_le_len,
- uint8_t * const p_uuid_le,
- uint32_t * const p_result_code)
- {
- SER_RSP_DEC_BEGIN(SD_BLE_UUID_ENCODE);
- uint8_t uuid_le_len;
- SER_PULL_uint8(&uuid_le_len);
- if (p_uuid_le_len)
- {
- *p_uuid_le_len = uuid_le_len;
- if (p_uuid_le)
- {
- SER_PULL_uint8array(p_uuid_le, uuid_le_len);
- }
- }
- SER_RSP_DEC_END;
- }
- uint32_t ble_uuid_vs_add_req_enc(ble_uuid128_t const * const p_vs_uuid,
- uint8_t * const p_uuid_type,
- uint8_t * const p_buf,
- uint32_t * const p_buf_len)
- {
- SER_REQ_ENC_BEGIN(SD_BLE_UUID_VS_ADD);
- SER_PUSH_COND(p_vs_uuid, ble_uuid128_t_enc);
- SER_PUSH_COND(p_uuid_type, NULL);
- SER_REQ_ENC_END;
- }
- uint32_t ble_uuid_vs_add_rsp_dec(uint8_t const * const p_buf,
- uint32_t packet_len,
- uint8_t * * const pp_uuid_type,
- uint32_t * const p_result_code)
- {
- SER_RSP_DEC_BEGIN(SD_BLE_UUID_VS_ADD);
- SER_ASSERT_NOT_NULL(pp_uuid_type);
- SER_PULL_COND(pp_uuid_type, uint8_t_dec);
- SER_RSP_DEC_END;
- }
- uint32_t ble_version_get_req_enc(ble_version_t const * const p_version,
- uint8_t * const p_buf,
- uint32_t * const p_buf_len)
- {
- SER_REQ_ENC_BEGIN(SD_BLE_VERSION_GET);
- SER_PUSH_COND(p_version, NULL);
- SER_REQ_ENC_END;
- }
- uint32_t ble_version_get_rsp_dec(uint8_t const * const p_buf,
- uint32_t packet_len,
- ble_version_t * p_version,
- uint32_t * const p_result_code)
- {
- SER_RSP_DEC_BEGIN(SD_BLE_VERSION_GET);
- SER_PULL_FIELD(p_version, ble_version_t_dec);
- SER_RSP_DEC_END;
- }
- #if NRF_SD_BLE_API_VERSION >= 4
- uint32_t ble_cfg_set_req_enc(uint32_t cfg_id,
- ble_cfg_t const * p_cfg,
- uint8_t * const p_buf,
- uint32_t * const p_buf_len)
- {
- SER_REQ_ENC_BEGIN(SD_BLE_CFG_SET);
- SER_PUSH_uint32(&cfg_id);
- field_encoder_handler_t fp_encoder = NULL;
- void const * p_struct = NULL;
- SER_PUSH_COND(p_cfg, NULL);
- if (p_cfg)
- {
- switch (cfg_id)
- {
- case BLE_CONN_CFG_GAP:
- fp_encoder = ble_gap_conn_cfg_t_enc;
- p_struct = &(p_cfg->conn_cfg.params.gap_conn_cfg);
- break;
- case BLE_CONN_CFG_GATTC:
- fp_encoder = ble_gattc_conn_cfg_t_enc;
- p_struct = &(p_cfg->conn_cfg.params.gattc_conn_cfg);
- break;
- case BLE_CONN_CFG_GATTS:
- fp_encoder = ble_gatts_conn_cfg_t_enc;
- p_struct = &(p_cfg->conn_cfg.params.gatts_conn_cfg);
- break;
- case BLE_CONN_CFG_GATT:
- fp_encoder = ble_gatt_conn_cfg_t_enc;
- p_struct = &(p_cfg->conn_cfg.params.gatt_conn_cfg);
- break;
- #if defined(NRF_SD_BLE_API_VERSION) && NRF_SD_BLE_API_VERSION >= 5 && !defined(S112)
- case BLE_CONN_CFG_L2CAP:
- fp_encoder = ble_l2cap_conn_cfg_t_enc;
- p_struct = &(p_cfg->conn_cfg.params.l2cap_conn_cfg);
- break;
- #endif
- case BLE_COMMON_CFG_VS_UUID:
- fp_encoder = ble_common_cfg_vs_uuid_t_enc;
- p_struct = &(p_cfg->common_cfg.vs_uuid_cfg);
- break;
- case BLE_GAP_CFG_ROLE_COUNT:
- fp_encoder = ble_gap_cfg_role_count_t_enc;
- p_struct = &(p_cfg->gap_cfg.role_count_cfg);
- break;
- case BLE_GAP_CFG_DEVICE_NAME:
- fp_encoder = ble_gap_cfg_device_name_t_enc;
- p_struct = &(p_cfg->gap_cfg.device_name_cfg);
- break;
- case BLE_GATTS_CFG_SERVICE_CHANGED:
- fp_encoder = ble_gatts_cfg_service_changed_t_enc;
- p_struct = &(p_cfg->gatts_cfg.service_changed);
- break;
- case BLE_GATTS_CFG_ATTR_TAB_SIZE:
- fp_encoder = ble_gatts_cfg_attr_tab_size_t_enc;
- p_struct = &(p_cfg->gatts_cfg.attr_tab_size);
- break;
- }
- if (cfg_id >= BLE_CONN_CFG_BASE && cfg_id <= BLE_CONN_CFG_GATT)
- {
- SER_PUSH_uint8(&p_cfg->conn_cfg.conn_cfg_tag);
- }
- SER_PUSH_FIELD(p_struct, fp_encoder);
- }
- SER_REQ_ENC_END;
- }
- uint32_t ble_cfg_set_rsp_dec(uint8_t const * const p_buf,
- uint32_t packet_len,
- uint32_t * const p_result_code)
- {
- SER_RSP_DEC_RESULT_ONLY(SD_BLE_CFG_SET);
- }
- #endif //NRF_SD_BLE_API_VERSION >= 4
|