123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687 |
- #include "sdk_common.h"
- #if NRF_MODULE_ENABLED(BLE_RACP)
- #include "ble_racp.h"
- #include <stdlib.h>
- void ble_racp_decode(uint8_t data_len, uint8_t const * p_data, ble_racp_value_t * p_racp_val)
- {
- p_racp_val->opcode = 0xFF;
- p_racp_val->operator = 0xFF;
- p_racp_val->operand_len = 0;
- p_racp_val->p_operand = NULL;
- if (data_len > 0)
- {
- p_racp_val->opcode = p_data[0];
- }
- if (data_len > 1)
- {
- p_racp_val->operator = p_data[1];
- }
- if (data_len > 2)
- {
- p_racp_val->operand_len = data_len - 2;
- p_racp_val->p_operand = (uint8_t*)&p_data[2];
- }
- }
- uint8_t ble_racp_encode(const ble_racp_value_t * p_racp_val, uint8_t * p_data)
- {
- uint8_t len = 0;
- int i;
- if (p_data != NULL)
- {
- p_data[len++] = p_racp_val->opcode;
- p_data[len++] = p_racp_val->operator;
- for (i = 0; i < p_racp_val->operand_len; i++)
- {
- p_data[len++] = p_racp_val->p_operand[i];
- }
- }
- return len;
- }
- #endif
|