mirror of
https://github.com/pengwon/epd42.git
synced 2026-03-22 09:59:55 +08:00
495 lines
17 KiB
C
495 lines
17 KiB
C
/**
|
|
* Copyright (c) 2014 - 2017, 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_l2cap.h"
|
|
#include "ble.h"
|
|
#include "cond_field_serialization.h"
|
|
#include <string.h>
|
|
|
|
|
|
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;
|
|
}
|
|
|
|
uint32_t ble_l2cap_header_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_l2cap_header_t);
|
|
|
|
SER_PUSH_uint16(&p_struct->len);
|
|
SER_PUSH_uint16(&p_struct->cid);
|
|
|
|
SER_STRUCT_ENC_END;
|
|
}
|
|
|
|
uint32_t ble_l2cap_header_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_l2cap_header_t);
|
|
|
|
SER_PULL_uint16(&p_struct->len);
|
|
SER_PULL_uint16(&p_struct->cid);
|
|
|
|
SER_STRUCT_DEC_END;
|
|
}
|
|
|
|
uint32_t ble_l2cap_evt_rx_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_l2cap_evt_rx_t);
|
|
|
|
SER_PUSH_FIELD(&p_struct->header, ble_l2cap_header_t_enc);
|
|
SER_PUSH_uint8array(p_struct->data, p_struct->header.len);
|
|
|
|
SER_STRUCT_ENC_END;
|
|
}
|
|
|
|
uint32_t ble_l2cap_evt_rx_t_dec(uint8_t const * const p_buf,
|
|
uint32_t buf_len,
|
|
uint32_t * const p_index,
|
|
uint32_t * const p_ext_len,
|
|
void * const p_void_struct)
|
|
{
|
|
SER_STRUCT_DEC_BEGIN(ble_l2cap_evt_rx_t);
|
|
|
|
SER_PULL_FIELD(&p_struct->header, ble_l2cap_header_t_dec);
|
|
|
|
uint32_t data_len = (SUB1(p_struct->header.len));
|
|
SER_ASSERT_LENGTH_LEQ(data_len, *p_ext_len);
|
|
|
|
SER_PULL_uint8array(p_struct->data, p_struct->header.len);
|
|
|
|
*p_ext_len = data_len;
|
|
SER_STRUCT_DEC_END;
|
|
}
|
|
|
|
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;
|
|
}
|
|
|
|
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;
|
|
}
|
|
|
|
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;
|
|
}
|
|
|
|
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;
|
|
}
|