uint32_t ser_sd_transport_cmd_write(const uint8_t * p_buffer,
uint16_t length,
ser_sd_transport_rsp_handler_t cmd_rsp_decode_callback)
{
uint32_t err_code = NRF_SUCCESS;
m_rsp_wait = true;
m_rsp_dec_handler = cmd_rsp_decode_callback;
err_code = ser_hal_transport_tx_pkt_send(p_buffer, length);
APP_ERROR_CHECK(err_code);
/* Execute callback for response decoding only if one was provided.*/
if ((err_code == NRF_SUCCESS) && cmd_rsp_decode_callback)
{
if (m_ot_rsp_wait_handler)
{
m_ot_rsp_wait_handler();
m_ot_rsp_wait_handler = NULL;
}
m_os_rsp_wait_handler();
err_code = m_return_value;
}
else
{
m_rsp_wait = false;
}
NRF_LOG_DEBUG("[SD_CALL]:%s, err_code= 0x%X\r\n", (uint32_t)ser_dbg_sd_call_str_get(p_buffer[1]), err_code);
return err_code;
}
uint32_t ser_conn_dtm_command_process(uint8_t * p_command, uint16_t command_len)
{
SER_ASSERT_NOT_NULL(p_command);
uint32_t err_code = NRF_SUCCESS;
uint8_t * p_tx_buf = NULL;
uint32_t tx_buf_len = 0;
/* Allocate a memory buffer from HAL Transport layer for transmitting the Command Response.
* Loop until a buffer is available. */
do
{
err_code = ser_hal_transport_tx_pkt_alloc(&p_tx_buf, (uint16_t *)&tx_buf_len);
if (err_code == NRF_ERROR_NO_MEM)
{
ser_conn_on_no_mem_handler();
}
}
while (NRF_ERROR_NO_MEM == err_code);
if (err_code == NRF_SUCCESS)
{
p_tx_buf[SER_PKT_TYPE_POS] = SER_PKT_TYPE_DTM_RESP;
tx_buf_len -= SER_PKT_TYPE_SIZE;
err_code = ble_dtm_init_req_dec(p_command, command_len, &m_comm_params);
if (NRF_SUCCESS == err_code)
{
err_code = ble_dtm_init_rsp_enc(NRF_SUCCESS,
&p_tx_buf[SER_PKT_TYPE_SIZE],
&tx_buf_len);
if (err_code != NRF_SUCCESS)
{
return NRF_ERROR_INTERNAL;
}
tx_buf_len += SER_PKT_TYPE_SIZE;
/* Set a flag that device is ready to enter DTM mode. */
m_is_ready_to_enter_dtm = true;
err_code = ser_hal_transport_tx_pkt_send(p_tx_buf, (uint16_t)tx_buf_len);
if (err_code != NRF_SUCCESS)
{
err_code = NRF_ERROR_INTERNAL;
}
/* TX buffer is going to be freed automatically in the HAL Transport layer. */
}
else
{
err_code = NRF_ERROR_INTERNAL;
}
}
return err_code;
}
void ser_conn_ble_event_encoder(void * p_event_data, uint16_t event_size)
{
if (NULL == p_event_data)
{
APP_ERROR_CHECK(NRF_ERROR_NULL);
}
UNUSED_PARAMETER(event_size);
uint32_t err_code = NRF_SUCCESS;
uint8_t * p_tx_buf = NULL;
uint32_t tx_buf_len = 0;
ble_evt_t * p_ble_evt = (ble_evt_t *)p_event_data;
/* Allocate a memory buffer from HAL Transport layer for transmitting an event.
* Loop until a buffer is available. */
do
{
err_code = ser_hal_transport_tx_pkt_alloc(&p_tx_buf, (uint16_t *)&tx_buf_len);
}
while (err_code == NRF_ERROR_NO_MEM);
APP_ERROR_CHECK(err_code);
/* Create a new packet. */
p_tx_buf[SER_PKT_TYPE_POS] = SER_PKT_TYPE_EVT;
tx_buf_len -= SER_PKT_TYPE_SIZE;
/* Pass a memory for an event (opcode + data) and encode it. */
err_code = ble_event_enc(p_ble_evt, 0, &p_tx_buf[SER_PKT_OP_CODE_POS], &tx_buf_len);
if (NRF_ERROR_NOT_SUPPORTED != err_code)
{
APP_ERROR_CHECK(err_code);
tx_buf_len += SER_PKT_TYPE_SIZE;
err_code = ser_hal_transport_tx_pkt_send(p_tx_buf, (uint16_t)tx_buf_len);
APP_ERROR_CHECK(err_code);
/* TX buffer is going to be freed automatically in the HAL Transport layer.
* Scheduler must be paused because this function returns before a packet is physically sent
* by transport layer. This can cause start processing of a next event from the application
* scheduler queue. In result the next event reserves the TX buffer before the current
* packet is sent. If in meantime a command arrives a command response cannot be sent in
* result. Pausing the scheduler temporary prevents processing a next event. */
app_sched_pause();
}
else
{
/* Event was NOT encoded, therefore the buffer is freed immediately. */
err_code = ser_hal_transport_tx_pkt_free(p_tx_buf);
APP_ERROR_CHECK(err_code);
APP_ERROR_CHECK(SER_WARNING_CODE);
}
}
uint32_t ser_conn_command_process(uint8_t * p_command, uint16_t command_len)
{
SER_ASSERT_NOT_NULL(p_command);
SER_ASSERT_LENGTH_LEQ(SER_OP_CODE_SIZE, command_len);
uint32_t err_code = NRF_SUCCESS;
uint8_t * p_tx_buf = NULL;
uint32_t tx_buf_len = 0;
uint8_t opcode = p_command[SER_CMD_OP_CODE_POS];
uint32_t index = 0;
/* Allocate a memory buffer from HAL Transport layer for transmitting the Command Response.
* Loop until a buffer is available. */
do
{
err_code = ser_hal_transport_tx_pkt_alloc(&p_tx_buf, (uint16_t *)&tx_buf_len);
}
while (NRF_ERROR_NO_MEM == err_code);
if (NRF_SUCCESS == err_code)
{
/* Create a new response packet. */
p_tx_buf[SER_PKT_TYPE_POS] = SER_PKT_TYPE_RESP;
tx_buf_len -= SER_PKT_TYPE_SIZE;
/* Decode a request, pass a memory for a response command (opcode + data) and encode it. */
err_code = conn_mw_handler
(p_command, command_len, &p_tx_buf[SER_PKT_OP_CODE_POS], &tx_buf_len);
/* Command decoder not found. */
if (NRF_ERROR_NOT_SUPPORTED == err_code)
{
APP_ERROR_CHECK(SER_WARNING_CODE);
err_code = op_status_enc
(opcode, NRF_ERROR_NOT_SUPPORTED,
&p_tx_buf[SER_PKT_OP_CODE_POS], &tx_buf_len, &index);
if (NRF_SUCCESS == err_code)
{
tx_buf_len += SER_PKT_TYPE_SIZE;
err_code = ser_hal_transport_tx_pkt_send(p_tx_buf, (uint16_t)tx_buf_len);
/* TX buffer is going to be freed automatically in the HAL Transport layer. */
if (NRF_SUCCESS != err_code)
{
err_code = NRF_ERROR_INTERNAL;
}
}
else
{
err_code = NRF_ERROR_INTERNAL;
}
}
else if (NRF_SUCCESS == err_code) /* Send a response. */
{
tx_buf_len += SER_PKT_TYPE_SIZE;
err_code = ser_hal_transport_tx_pkt_send(p_tx_buf, (uint16_t)tx_buf_len);
/* TX buffer is going to be freed automatically in the HAL Transport layer. */
if (NRF_SUCCESS != err_code)
{
err_code = NRF_ERROR_INTERNAL;
}
}
else
{
err_code = NRF_ERROR_INTERNAL;
}
}
else
{
err_code = NRF_ERROR_INTERNAL;
}
return err_code;
}
