uint32_t temp_get_rsp_enc(uint32_t return_code,
uint8_t * const p_buf,
uint32_t * const p_buf_len,
int32_t * const p_temp)
{
SER_ASSERT_NOT_NULL(p_buf);
SER_ASSERT_NOT_NULL(p_temp);
SER_ASSERT_NOT_NULL(p_buf_len);
uint32_t index = 0;
uint32_t err_code = NRF_SUCCESS;
uint32_t total_len = *p_buf_len;
err_code = ser_ble_cmd_rsp_status_code_enc(SD_TEMP_GET,
return_code,
p_buf,
p_buf_len);
SER_ASSERT(err_code == NRF_SUCCESS, err_code);
index += *p_buf_len;
if (return_code == NRF_SUCCESS)
{
err_code = uint32_t_enc(p_temp, p_buf, total_len, &index);
SER_ASSERT(err_code == NRF_SUCCESS, err_code);
}
*p_buf_len = index;
return err_code;
}
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)
{
uint32_t index = 0;
uint32_t err_code;
SER_ASSERT_NOT_NULL(p_buf);
SER_ASSERT_NOT_NULL(p_buf_len);
SER_ASSERT_LENGTH_LEQ(1+4+1, *p_buf_len); // [OPCODE][OP_ID][PRESENT]
SER_ASSERT(((opt_id == BLE_GAP_OPT_LOCAL_CONN_LATENCY) ||
(opt_id == BLE_GAP_OPT_PASSKEY) ||
(opt_id == BLE_GAP_OPT_PRIVACY)), NRF_ERROR_INVALID_PARAM);
p_buf[index++] = SD_BLE_OPT_GET;
err_code = uint32_t_enc(&opt_id, p_buf, *p_buf_len, &index);
if (err_code != NRF_SUCCESS)
{
return err_code;
}
p_buf[index++] = (p_opt == NULL) ? SER_FIELD_NOT_PRESENT : SER_FIELD_PRESENT;
*p_buf_len = index;
return NRF_SUCCESS;
}
uint32_t ANT_ENABLE_enc(void const * const p_void_enable_params,
uint8_t * const p_buf,
uint32_t buf_len,
uint32_t * const p_index)
{
SER_ASSERT_NOT_NULL(p_buf);
SER_ASSERT_NOT_NULL(p_index);
SER_ASSERT_NOT_NULL(p_void_enable_params);
ANT_ENABLE * p_enable_params = (ANT_ENABLE *)p_void_enable_params;
uint32_t err_code = NRF_SUCCESS;
err_code = uint8_t_enc(&p_enable_params->ucTotalNumberOfChannels, p_buf, buf_len, p_index);
SER_ASSERT(err_code == NRF_SUCCESS, err_code);
err_code = uint8_t_enc(&p_enable_params->ucNumberOfEncryptedChannels, p_buf, buf_len, p_index);
SER_ASSERT(err_code == NRF_SUCCESS, err_code);
err_code = uint16_t_enc(&p_enable_params->usNumberOfEvents, p_buf, buf_len, p_index);
SER_ASSERT(err_code == NRF_SUCCESS, err_code);
err_code = uint32_t_enc(&p_enable_params->pucMemoryBlockStartLocation, p_buf, buf_len, p_index);
SER_ASSERT(err_code == NRF_SUCCESS, err_code);
err_code = uint16_t_enc(&p_enable_params->usMemoryBlockByteSize, p_buf, buf_len, p_index);
SER_ASSERT(err_code == NRF_SUCCESS, err_code);
return err_code;
}
uint32_t ble_opt_get_rsp_enc(uint32_t return_code,
uint8_t * const p_buf,
uint32_t * const p_buf_len,
uint32_t opt_id,
ble_opt_t const * const p_opt)
{
SER_ASSERT_NOT_NULL(p_buf);
SER_ASSERT_NOT_NULL(p_buf_len);
uint32_t total_len = *p_buf_len;
uint32_t err_code = ser_ble_cmd_rsp_status_code_enc(SD_BLE_OPT_GET, return_code,
p_buf, p_buf_len);
if (err_code != NRF_SUCCESS)
{
return err_code;
}
if (return_code != NRF_SUCCESS)
{
return NRF_SUCCESS;
}
SER_ASSERT_NOT_NULL(p_opt);
SER_ASSERT(((opt_id == BLE_GAP_OPT_LOCAL_CONN_LATENCY) ||
(opt_id == BLE_GAP_OPT_PASSKEY) ||
(opt_id == BLE_GAP_OPT_PRIVACY)), NRF_ERROR_INVALID_PARAM);
uint32_t index = *p_buf_len;
err_code = uint32_t_enc(&opt_id, p_buf, total_len, &index);
if (err_code != NRF_SUCCESS)
{
return err_code;
}
switch (opt_id)
{
case BLE_GAP_OPT_LOCAL_CONN_LATENCY:
err_code = ble_gap_opt_local_conn_latency_t_enc((void *)&(p_opt->gap.local_conn_latency), p_buf, total_len, &index);
break;
case BLE_GAP_OPT_PASSKEY:
err_code = ble_gap_opt_passkey_t_enc( (void *)&(p_opt->gap.passkey), p_buf, total_len, &index );
break;
case BLE_GAP_OPT_PRIVACY:
err_code = ble_gap_opt_privacy_t_enc( (void *)&(p_opt->gap.privacy), p_buf, total_len, &index );
break;
}
if (err_code != NRF_SUCCESS)
{
return err_code;
}
*p_buf_len = index;
return NRF_SUCCESS;
}
uint32_t ble_enable_params_t_enc(void const * const p_data,
uint8_t * const p_buf,
uint32_t buf_len,
uint32_t * const p_index)
{
uint32_t err_code = NRF_SUCCESS;
ble_enable_params_t * p_enable_params = (ble_enable_params_t *)p_data;
SER_ASSERT_LENGTH_LEQ(1, buf_len - *p_index);
p_buf[*p_index] = p_enable_params->gatts_enable_params.service_changed;
(*p_index)++;
err_code = uint32_t_enc(&(p_enable_params->gatts_enable_params.attr_tab_size), p_buf, buf_len, p_index);
SER_ASSERT(err_code == NRF_SUCCESS, err_code);
return err_code;
}
uint32_t ble_gatts_enable_params_t_enc(void const * const p_void_struct,
uint8_t * const p_buf,
uint32_t buf_len,
uint32_t * const p_index)
{
ble_gatts_enable_params_t * p_enable_params = (ble_gatts_enable_params_t *)p_void_struct;
uint32_t err_code = NRF_SUCCESS;
uint8_t temp8 = 0;
temp8 = (p_enable_params->service_changed & 0x01);
err_code = uint8_t_enc((void *) &temp8, p_buf, buf_len, p_index);
SER_ASSERT(err_code == NRF_SUCCESS, err_code);
err_code = uint32_t_enc(&(p_enable_params->attr_tab_size), p_buf, buf_len, p_index);
SER_ASSERT(err_code == NRF_SUCCESS, err_code);
return err_code;
}
uint32_t ble_gatts_sys_attr_set_req_enc(uint16_t conn_handle,
uint8_t const * const p_sys_attr_data,
uint16_t sys_attr_data_len,
uint32_t flags,
uint8_t * const p_buf,
uint32_t * const p_buf_len)
{
uint32_t index = 0;
uint32_t err_code = NRF_SUCCESS;
SER_ASSERT_NOT_NULL(p_buf);
SER_ASSERT_NOT_NULL(p_buf_len);
SER_ASSERT_LENGTH_LEQ(index + 8, *p_buf_len);
p_buf[index++] = SD_BLE_GATTS_SYS_ATTR_SET;
index += uint16_encode(conn_handle, &p_buf[index]);
p_buf[index++] = (p_sys_attr_data != NULL) ? SER_FIELD_PRESENT : SER_FIELD_NOT_PRESENT;
if (p_sys_attr_data != NULL)
{
//lint -save -esym(670,memcpy)
SER_ERROR_CHECK(sys_attr_data_len <= BLE_GATTS_VAR_ATTR_LEN_MAX, NRF_ERROR_INVALID_PARAM);
SER_ASSERT_LENGTH_LEQ(index + 2 + sys_attr_data_len + 4, *p_buf_len);
index += uint16_encode(sys_attr_data_len, &p_buf[index]);
memcpy(&(p_buf[index]), p_sys_attr_data, sys_attr_data_len);
//lint -restore
index += sys_attr_data_len;
}
err_code = uint32_t_enc(&flags, p_buf, *p_buf_len, &index);
SER_ASSERT(err_code == NRF_SUCCESS, err_code);
*p_buf_len = index;
return NRF_SUCCESS;
}
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)
{
uint32_t index = 0;
uint32_t err_code = NRF_SUCCESS;
SER_ASSERT_NOT_NULL(p_buf);
SER_ASSERT_NOT_NULL(p_buf_len);
uint32_t initial_buf_len = *p_buf_len;
SER_ASSERT_LENGTH_LEQ(1 + 4 + 1, initial_buf_len);
SER_ASSERT(((opt_id == BLE_COMMON_OPT_RADIO_CPU_MUTEX) ||
(opt_id == BLE_GAP_OPT_CH_MAP) ||
(opt_id == BLE_GAP_OPT_LOCAL_CONN_LATENCY) ||
(opt_id == BLE_GAP_OPT_PASSKEY) ||
(opt_id == BLE_GAP_OPT_PRIVACY) ||
(opt_id == BLE_GAP_OPT_SCAN_REQ_REPORT) ||
(opt_id == BLE_GAP_OPT_COMPAT_MODE)), NRF_ERROR_INVALID_PARAM);
p_buf[index++] = SD_BLE_OPT_SET;
err_code = uint32_t_enc(&opt_id, p_buf, initial_buf_len, &index);
SER_ASSERT(err_code == NRF_SUCCESS, err_code);
if (p_opt != NULL)
{
p_buf[index++] = SER_FIELD_PRESENT;
switch(opt_id)
{
case BLE_COMMON_OPT_RADIO_CPU_MUTEX:
err_code = ble_common_opt_radio_cpu_mutex_t_enc(&(p_opt->common_opt.radio_cpu_mutex),p_buf, initial_buf_len, &index);
break;
case BLE_GAP_OPT_CH_MAP:
err_code = ble_gap_opt_ch_map_t_enc(&(p_opt->gap_opt.ch_map),p_buf, initial_buf_len, &index);
break;
case BLE_GAP_OPT_LOCAL_CONN_LATENCY:
err_code = ble_gap_opt_local_conn_latency_t_enc(&(p_opt->gap_opt.local_conn_latency),p_buf, initial_buf_len, &index);
break;
case BLE_GAP_OPT_PASSKEY:
err_code = ble_gap_opt_passkey_t_enc(&(p_opt->gap_opt.passkey),p_buf, initial_buf_len, &index);
break;
case BLE_GAP_OPT_PRIVACY:
err_code = ble_gap_opt_privacy_t_enc(&(p_opt->gap_opt.privacy),p_buf, initial_buf_len, &index);
break;
case BLE_GAP_OPT_SCAN_REQ_REPORT:
err_code = ble_gap_opt_scan_req_report_t_enc(&(p_opt->gap_opt.scan_req_report),p_buf, initial_buf_len, &index);
break;
case BLE_GAP_OPT_COMPAT_MODE:
err_code = ble_gap_opt_compat_mode_t_enc(&(p_opt->gap_opt.compat_mode),p_buf, initial_buf_len, &index);
break;
}
}
else
{
p_buf[index++] = SER_FIELD_NOT_PRESENT;
}
if (err_code != NRF_SUCCESS)
{
return err_code;
}
*p_buf_len = index;
return err_code;
}
uint32_t ble_opt_get_rsp_enc(uint32_t return_code,
uint8_t * const p_buf,
uint32_t * const p_buf_len,
uint32_t opt_id,
ble_opt_t const * const p_opt)
{
SER_ASSERT_NOT_NULL(p_buf);
SER_ASSERT_NOT_NULL(p_buf_len);
uint32_t total_len = *p_buf_len;
uint32_t err_code = ser_ble_cmd_rsp_status_code_enc(SD_BLE_OPT_GET, return_code,
p_buf, p_buf_len);
if (err_code != NRF_SUCCESS)
{
return err_code;
}
if (return_code != NRF_SUCCESS)
{
return NRF_SUCCESS;
}
SER_ASSERT_NOT_NULL(p_opt);
SER_ASSERT(((opt_id == BLE_COMMON_OPT_RADIO_CPU_MUTEX) ||
(opt_id == BLE_GAP_OPT_CH_MAP) ||
(opt_id == BLE_GAP_OPT_LOCAL_CONN_LATENCY) ||
(opt_id == BLE_GAP_OPT_PASSKEY) ||
(opt_id == BLE_GAP_OPT_PRIVACY) ||
(opt_id == BLE_GAP_OPT_SCAN_REQ_REPORT) ||
(opt_id == BLE_GAP_OPT_COMPAT_MODE)), NRF_ERROR_INVALID_PARAM);
uint32_t index = *p_buf_len;
err_code = uint32_t_enc(&opt_id, p_buf, total_len, &index);
if (err_code != NRF_SUCCESS)
{
return err_code;
}
switch (opt_id)
{
case BLE_COMMON_OPT_RADIO_CPU_MUTEX:
err_code = ble_common_opt_radio_cpu_mutex_t_enc((void *)&(p_opt->common_opt.radio_cpu_mutex), p_buf, total_len, &index);
break;
case BLE_GAP_OPT_CH_MAP:
err_code = ble_gap_opt_ch_map_t_enc((void *)&(p_opt->gap_opt.ch_map), p_buf, total_len, &index);
break;
case BLE_GAP_OPT_LOCAL_CONN_LATENCY:
err_code = ble_gap_opt_local_conn_latency_t_enc((void *)&(p_opt->gap_opt.local_conn_latency), p_buf, total_len, &index);
break;
case BLE_GAP_OPT_PASSKEY:
err_code = ble_gap_opt_passkey_t_enc((void *)&(p_opt->gap_opt.passkey), p_buf, total_len, &index);
break;
case BLE_GAP_OPT_PRIVACY:
err_code = ble_gap_opt_privacy_t_enc((void *)&(p_opt->gap_opt.privacy), p_buf, total_len, &index);
break;
case BLE_GAP_OPT_SCAN_REQ_REPORT:
err_code = ble_gap_opt_scan_req_report_t_enc((void *)&(p_opt->gap_opt.scan_req_report), p_buf, total_len, &index);
break;
case BLE_GAP_OPT_COMPAT_MODE:
err_code = ble_gap_opt_compat_mode_t_enc((void *)&(p_opt->gap_opt.compat_mode), p_buf, total_len, &index);
break;
}
if (err_code != NRF_SUCCESS)
{
return err_code;
}
*p_buf_len = index;
return NRF_SUCCESS;
}
