123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838 |
- #include "ble_advdata.h"
- #include "ble_gap.h"
- #include "ble_srv_common.h"
- #include "sdk_common.h"
- #define AD_TYPE_BLE_DEVICE_ADDR_TYPE_PUBLIC 0UL
- #define AD_TYPE_BLE_DEVICE_ADDR_TYPE_RANDOM 1UL
- #define UUID16_SIZE 2
- #define UUID32_SIZE 4
- #define UUID128_SIZE 16
- #define N_AD_TYPES 2
- static ret_code_t ble_device_addr_encode(uint8_t * p_encoded_data,
- uint16_t * p_offset,
- uint16_t max_size)
- {
- ret_code_t err_code;
- ble_gap_addr_t device_addr;
-
- if (((*p_offset) + AD_TYPE_BLE_DEVICE_ADDR_SIZE) > max_size)
- {
- return NRF_ERROR_DATA_SIZE;
- }
-
- err_code = sd_ble_gap_addr_get(&device_addr);
- VERIFY_SUCCESS(err_code);
-
- p_encoded_data[*p_offset] = (uint8_t)(AD_TYPE_FIELD_SIZE +
- AD_TYPE_BLE_DEVICE_ADDR_DATA_SIZE);
- *p_offset += AD_LENGTH_FIELD_SIZE;
- p_encoded_data[*p_offset] = BLE_GAP_AD_TYPE_LE_BLUETOOTH_DEVICE_ADDRESS;
- *p_offset += AD_TYPE_FIELD_SIZE;
- memcpy(&p_encoded_data[*p_offset], &device_addr.addr[0], BLE_GAP_ADDR_LEN);
- *p_offset += BLE_GAP_ADDR_LEN;
- if (BLE_GAP_ADDR_TYPE_PUBLIC == device_addr.addr_type)
- {
- p_encoded_data[*p_offset] = AD_TYPE_BLE_DEVICE_ADDR_TYPE_PUBLIC;
- }
- else
- {
- p_encoded_data[*p_offset] = AD_TYPE_BLE_DEVICE_ADDR_TYPE_RANDOM;
- }
- *p_offset += AD_TYPE_BLE_DEVICE_ADDR_TYPE_SIZE;
- return NRF_SUCCESS;
- }
- static ret_code_t name_encode(const ble_advdata_t * p_advdata,
- uint8_t * p_encoded_data,
- uint16_t * p_offset,
- uint16_t max_size)
- {
- ret_code_t err_code;
- uint16_t rem_adv_data_len;
- uint16_t actual_length;
- uint8_t adv_data_format;
-
- if ((BLE_ADVDATA_SHORT_NAME == p_advdata->name_type) && (0 == p_advdata->short_name_len))
- {
- return NRF_ERROR_INVALID_PARAM;
- }
-
- if ( (((*p_offset) + AD_DATA_OFFSET) > max_size) ||
- ( (BLE_ADVDATA_SHORT_NAME == p_advdata->name_type) &&
- (((*p_offset) + AD_DATA_OFFSET + p_advdata->short_name_len) > max_size)))
- {
- return NRF_ERROR_DATA_SIZE;
- }
- rem_adv_data_len = max_size - (*p_offset) - AD_DATA_OFFSET;
- actual_length = rem_adv_data_len;
-
- err_code = sd_ble_gap_device_name_get(&p_encoded_data[(*p_offset) + AD_DATA_OFFSET],
- &actual_length);
- VERIFY_SUCCESS(err_code);
-
-
-
- if (((p_advdata->name_type == BLE_ADVDATA_FULL_NAME) ||
- (actual_length <= p_advdata->short_name_len)) &&
- (actual_length <= rem_adv_data_len))
- {
-
- adv_data_format = BLE_GAP_AD_TYPE_COMPLETE_LOCAL_NAME;
- }
- else
- {
-
- adv_data_format = BLE_GAP_AD_TYPE_SHORT_LOCAL_NAME;
-
-
- if ((BLE_ADVDATA_SHORT_NAME == p_advdata->name_type) &&
- (p_advdata->short_name_len <= rem_adv_data_len))
- {
-
- actual_length = p_advdata->short_name_len;
- }
-
- else
- {
- actual_length = rem_adv_data_len;
- }
- }
-
- if (actual_length > (0x00FF - AD_TYPE_FIELD_SIZE))
- {
- return NRF_ERROR_DATA_SIZE;
- }
-
- p_encoded_data[*p_offset] = (uint8_t)(AD_TYPE_FIELD_SIZE + actual_length);
- *p_offset += AD_LENGTH_FIELD_SIZE;
- p_encoded_data[*p_offset] = adv_data_format;
- *p_offset += AD_TYPE_FIELD_SIZE;
- *p_offset += actual_length;
- return NRF_SUCCESS;
- }
- static ret_code_t appearance_encode(uint8_t * p_encoded_data,
- uint16_t * p_offset,
- uint16_t max_size)
- {
- ret_code_t err_code;
- uint16_t appearance;
-
- if (((*p_offset) + AD_TYPE_APPEARANCE_SIZE) > max_size)
- {
- return NRF_ERROR_DATA_SIZE;
- }
-
- err_code = sd_ble_gap_appearance_get(&appearance);
- VERIFY_SUCCESS(err_code);
-
- p_encoded_data[*p_offset] = (uint8_t)(AD_TYPE_FIELD_SIZE + AD_TYPE_APPEARANCE_DATA_SIZE);
- *p_offset += AD_LENGTH_FIELD_SIZE;
- p_encoded_data[*p_offset] = BLE_GAP_AD_TYPE_APPEARANCE;
- *p_offset += AD_TYPE_FIELD_SIZE;
- *p_offset += uint16_encode(appearance, &p_encoded_data[*p_offset]);
- return NRF_SUCCESS;
- }
- static ret_code_t flags_encode(int8_t flags,
- uint8_t * p_encoded_data,
- uint16_t * p_offset,
- uint16_t max_size)
- {
-
- if (((*p_offset) + AD_TYPE_FLAGS_SIZE) > max_size)
- {
- return NRF_ERROR_DATA_SIZE;
- }
-
- p_encoded_data[*p_offset] = (uint8_t)(AD_TYPE_FIELD_SIZE + AD_TYPE_FLAGS_DATA_SIZE);
- *p_offset += AD_LENGTH_FIELD_SIZE;
- p_encoded_data[*p_offset] = BLE_GAP_AD_TYPE_FLAGS;
- *p_offset += AD_TYPE_FIELD_SIZE;
- p_encoded_data[*p_offset] = flags;
- *p_offset += AD_TYPE_FLAGS_DATA_SIZE;
- return NRF_SUCCESS;
- }
- static ret_code_t tx_power_level_encode(int8_t tx_power_level,
- uint8_t * p_encoded_data,
- uint16_t * p_offset,
- uint16_t max_size)
- {
-
- if (((*p_offset) + AD_TYPE_TX_POWER_LEVEL_SIZE) > max_size)
- {
- return NRF_ERROR_DATA_SIZE;
- }
-
- p_encoded_data[*p_offset] = (uint8_t)(AD_TYPE_FIELD_SIZE +
- AD_TYPE_TX_POWER_LEVEL_DATA_SIZE);
- *p_offset += AD_LENGTH_FIELD_SIZE;
- p_encoded_data[*p_offset] = BLE_GAP_AD_TYPE_TX_POWER_LEVEL;
- *p_offset += AD_TYPE_FIELD_SIZE;
- p_encoded_data[*p_offset] = tx_power_level;
- *p_offset += AD_TYPE_TX_POWER_LEVEL_DATA_SIZE;
- return NRF_SUCCESS;
- }
- static ret_code_t uuid_list_sized_encode(const ble_advdata_uuid_list_t * p_uuid_list,
- uint8_t adv_type,
- uint8_t uuid_size,
- uint8_t * p_encoded_data,
- uint16_t * p_offset,
- uint16_t max_size)
- {
- int i;
- bool is_heading_written = false;
- uint16_t start_pos = *p_offset;
- uint16_t length;
- for (i = 0; i < p_uuid_list->uuid_cnt; i++)
- {
- ret_code_t err_code;
- uint8_t encoded_size;
- ble_uuid_t uuid = p_uuid_list->p_uuids[i];
-
- err_code = sd_ble_uuid_encode(&uuid, &encoded_size, NULL);
- VERIFY_SUCCESS(err_code);
-
- if (encoded_size == uuid_size)
- {
- uint8_t heading_bytes = (is_heading_written) ? 0 : AD_DATA_OFFSET;
-
- if (((*p_offset) + encoded_size + heading_bytes) > max_size)
- {
- return NRF_ERROR_DATA_SIZE;
- }
- if (!is_heading_written)
- {
-
- *p_offset += AD_LENGTH_FIELD_SIZE;
- p_encoded_data[*p_offset] = adv_type;
- *p_offset += AD_TYPE_FIELD_SIZE;
- is_heading_written = true;
- }
-
- err_code = sd_ble_uuid_encode(&uuid, &encoded_size, &p_encoded_data[*p_offset]);
- VERIFY_SUCCESS(err_code);
- *p_offset += encoded_size;
- }
- }
- if (is_heading_written)
- {
-
- length = (*p_offset) - (start_pos + AD_LENGTH_FIELD_SIZE);
-
- if (length > 0x00FF)
- {
- return NRF_ERROR_DATA_SIZE;
- }
- p_encoded_data[start_pos] = (uint8_t)length;
- }
- return NRF_SUCCESS;
- }
- static ret_code_t uuid_list_encode(const ble_advdata_uuid_list_t * p_uuid_list,
- uint8_t adv_type_16,
- uint8_t adv_type_128,
- uint8_t * p_encoded_data,
- uint16_t * p_offset,
- uint16_t max_size)
- {
- ret_code_t err_code;
-
- err_code = uuid_list_sized_encode(p_uuid_list,
- adv_type_16,
- sizeof(uint16_le_t),
- p_encoded_data,
- p_offset,
- max_size);
- VERIFY_SUCCESS(err_code);
-
- err_code = uuid_list_sized_encode(p_uuid_list,
- adv_type_128,
- sizeof(ble_uuid128_t),
- p_encoded_data,
- p_offset,
- max_size);
- VERIFY_SUCCESS(err_code);
- return NRF_SUCCESS;
- }
- static ret_code_t conn_int_check(const ble_advdata_conn_int_t *p_conn_int)
- {
-
- if ((p_conn_int->min_conn_interval < 0x0006) ||
- (
- (p_conn_int->min_conn_interval > 0x0c80) &&
- (p_conn_int->min_conn_interval != 0xffff)
- )
- )
- {
- return NRF_ERROR_INVALID_PARAM;
- }
-
- if ((p_conn_int->max_conn_interval < 0x0006) ||
- (
- (p_conn_int->max_conn_interval > 0x0c80) &&
- (p_conn_int->max_conn_interval != 0xffff)
- )
- )
- {
- return NRF_ERROR_INVALID_PARAM;
- }
-
- if ((p_conn_int->min_conn_interval != 0xffff) &&
- (p_conn_int->max_conn_interval != 0xffff) &&
- (p_conn_int->min_conn_interval > p_conn_int->max_conn_interval)
- )
- {
- return NRF_ERROR_INVALID_PARAM;
- }
- return NRF_SUCCESS;
- }
- static ret_code_t conn_int_encode(const ble_advdata_conn_int_t * p_conn_int,
- uint8_t * p_encoded_data,
- uint16_t * p_offset,
- uint16_t max_size)
- {
- ret_code_t err_code;
-
- if (((*p_offset) + AD_TYPE_CONN_INT_SIZE) > max_size)
- {
- return NRF_ERROR_DATA_SIZE;
- }
-
- err_code = conn_int_check(p_conn_int);
- VERIFY_SUCCESS(err_code);
-
- p_encoded_data[*p_offset] = (uint8_t)(AD_TYPE_FIELD_SIZE + AD_TYPE_CONN_INT_DATA_SIZE);
- *p_offset += AD_LENGTH_FIELD_SIZE;
- p_encoded_data[*p_offset] = BLE_GAP_AD_TYPE_SLAVE_CONNECTION_INTERVAL_RANGE;
- *p_offset += AD_TYPE_FIELD_SIZE;
-
- *p_offset += uint16_encode(p_conn_int->min_conn_interval, &p_encoded_data[*p_offset]);
- *p_offset += uint16_encode(p_conn_int->max_conn_interval, &p_encoded_data[*p_offset]);
- return NRF_SUCCESS;
- }
- static ret_code_t manuf_specific_data_encode(const ble_advdata_manuf_data_t * p_manuf_sp_data,
- uint8_t * p_encoded_data,
- uint16_t * p_offset,
- uint16_t max_size)
- {
- uint32_t data_size = AD_TYPE_MANUF_SPEC_DATA_ID_SIZE + p_manuf_sp_data->data.size;
-
- if (((*p_offset) + AD_DATA_OFFSET + data_size) > max_size)
- {
- return NRF_ERROR_DATA_SIZE;
- }
-
- if (data_size > (0x00FF - AD_TYPE_FIELD_SIZE))
- {
- return NRF_ERROR_DATA_SIZE;
- }
-
- p_encoded_data[*p_offset] = (uint8_t)(AD_TYPE_FIELD_SIZE + data_size);
- *p_offset += AD_LENGTH_FIELD_SIZE;
- p_encoded_data[*p_offset] = BLE_GAP_AD_TYPE_MANUFACTURER_SPECIFIC_DATA;
- *p_offset += AD_TYPE_FIELD_SIZE;
-
- *p_offset += uint16_encode(p_manuf_sp_data->company_identifier, &p_encoded_data[*p_offset]);
-
- if (p_manuf_sp_data->data.size > 0)
- {
- if (p_manuf_sp_data->data.p_data == NULL)
- {
- return NRF_ERROR_INVALID_PARAM;
- }
- memcpy(&p_encoded_data[*p_offset], p_manuf_sp_data->data.p_data, p_manuf_sp_data->data.size);
- *p_offset += p_manuf_sp_data->data.size;
- }
- return NRF_SUCCESS;
- }
- static ret_code_t service_data_encode(const ble_advdata_t * p_advdata,
- uint8_t * p_encoded_data,
- uint16_t * p_offset,
- uint16_t max_size)
- {
- uint8_t i;
-
- if (p_advdata->p_service_data_array == NULL)
- {
- return NRF_ERROR_INVALID_PARAM;
- }
- for (i = 0; i < p_advdata->service_data_count; i++)
- {
- ble_advdata_service_data_t * p_service_data;
- uint32_t data_size;
- p_service_data = &p_advdata->p_service_data_array[i];
-
- data_size = AD_TYPE_SERV_DATA_16BIT_UUID_SIZE + p_service_data->data.size;
-
- if (data_size > (0x00FF - AD_TYPE_FIELD_SIZE))
- {
- return NRF_ERROR_DATA_SIZE;
- }
-
- p_encoded_data[*p_offset] = (uint8_t)(AD_TYPE_FIELD_SIZE + data_size);
- *p_offset += AD_LENGTH_FIELD_SIZE;
- p_encoded_data[*p_offset] = BLE_GAP_AD_TYPE_SERVICE_DATA;
- *p_offset += AD_TYPE_FIELD_SIZE;
-
- *p_offset += uint16_encode(p_service_data->service_uuid, &p_encoded_data[*p_offset]);
-
- if (p_service_data->data.size > 0)
- {
- if (p_service_data->data.p_data == NULL)
- {
- return NRF_ERROR_INVALID_PARAM;
- }
- memcpy(&p_encoded_data[*p_offset], p_service_data->data.p_data, p_service_data->data.size);
- *p_offset += p_service_data->data.size;
- }
- }
- return NRF_SUCCESS;
- }
- ret_code_t ble_advdata_encode(ble_advdata_t const * const p_advdata,
- uint8_t * const p_encoded_data,
- uint16_t * const p_len)
- {
- ret_code_t err_code = NRF_SUCCESS;
- uint16_t max_size = *p_len;
- *p_len = 0;
-
- if (p_advdata->include_ble_device_addr)
- {
- err_code = ble_device_addr_encode(p_encoded_data, p_len, max_size);
- VERIFY_SUCCESS(err_code);
- }
-
- if (p_advdata->include_appearance)
- {
- err_code = appearance_encode(p_encoded_data, p_len, max_size);
- VERIFY_SUCCESS(err_code);
- }
-
- if (p_advdata->flags != 0 )
- {
- err_code = flags_encode(p_advdata->flags, p_encoded_data, p_len, max_size);
- VERIFY_SUCCESS(err_code);
- }
-
- if (p_advdata->p_tx_power_level != NULL)
- {
- err_code = tx_power_level_encode(*p_advdata->p_tx_power_level,
- p_encoded_data,
- p_len,
- max_size);
- VERIFY_SUCCESS(err_code);
- }
-
- if (p_advdata->uuids_more_available.uuid_cnt > 0)
- {
- err_code = uuid_list_encode(&p_advdata->uuids_more_available,
- BLE_GAP_AD_TYPE_16BIT_SERVICE_UUID_MORE_AVAILABLE,
- BLE_GAP_AD_TYPE_128BIT_SERVICE_UUID_MORE_AVAILABLE,
- p_encoded_data,
- p_len,
- max_size);
- VERIFY_SUCCESS(err_code);
- }
-
- if (p_advdata->uuids_complete.uuid_cnt > 0)
- {
- err_code = uuid_list_encode(&p_advdata->uuids_complete,
- BLE_GAP_AD_TYPE_16BIT_SERVICE_UUID_COMPLETE,
- BLE_GAP_AD_TYPE_128BIT_SERVICE_UUID_COMPLETE,
- p_encoded_data,
- p_len,
- max_size);
- VERIFY_SUCCESS(err_code);
- }
-
- if (p_advdata->uuids_solicited.uuid_cnt > 0)
- {
- err_code = uuid_list_encode(&p_advdata->uuids_solicited,
- BLE_GAP_AD_TYPE_SOLICITED_SERVICE_UUIDS_16BIT,
- BLE_GAP_AD_TYPE_SOLICITED_SERVICE_UUIDS_128BIT,
- p_encoded_data,
- p_len,
- max_size);
- VERIFY_SUCCESS(err_code);
- }
-
- if (p_advdata->p_slave_conn_int != NULL)
- {
- err_code = conn_int_encode(p_advdata->p_slave_conn_int, p_encoded_data, p_len, max_size);
- VERIFY_SUCCESS(err_code);
- }
-
- if (p_advdata->p_manuf_specific_data != NULL)
- {
- err_code = manuf_specific_data_encode(p_advdata->p_manuf_specific_data,
- p_encoded_data,
- p_len,
- max_size);
- VERIFY_SUCCESS(err_code);
- }
-
- if (p_advdata->service_data_count > 0)
- {
- err_code = service_data_encode(p_advdata, p_encoded_data, p_len, max_size);
- VERIFY_SUCCESS(err_code);
- }
-
- if (p_advdata->name_type != BLE_ADVDATA_NO_NAME)
- {
- err_code = name_encode(p_advdata, p_encoded_data, p_len, max_size);
- VERIFY_SUCCESS(err_code);
- }
- return err_code;
- }
- uint16_t ble_advdata_search(uint8_t const * p_encoded_data,
- uint16_t data_len,
- uint16_t * p_offset,
- uint8_t ad_type)
- {
- if ((p_encoded_data == NULL) || (p_offset == NULL))
- {
- return 0;
- }
- uint16_t i = 0;
- while ((i + 1 < data_len) && ((i < *p_offset) || (p_encoded_data[i + 1] != ad_type)))
- {
-
- i += (p_encoded_data[i] + 1);
- }
- if (i >= data_len)
- {
- return 0;
- }
- else
- {
- uint16_t offset = i + 2;
- uint16_t len = p_encoded_data[i] ? (p_encoded_data[i] - 1) : 0;
- if (!len || ((offset + len) > data_len))
- {
-
- return 0;
- }
- *p_offset = offset;
- return len;
- }
- }
- uint8_t * ble_advdata_parse(uint8_t * p_encoded_data,
- uint16_t data_len,
- uint8_t ad_type)
- {
- uint16_t offset = 0;
- uint16_t len = ble_advdata_search(p_encoded_data, data_len, &offset, ad_type);
- if (len == 0)
- {
- return NULL;
- }
- else
- {
- return &p_encoded_data[offset];
- }
- }
- bool ble_advdata_name_find(uint8_t const * p_encoded_data,
- uint16_t data_len,
- char const * p_target_name)
- {
- uint16_t parsed_name_len;
- uint8_t const * p_parsed_name;
- uint16_t data_offset = 0;
- if (p_target_name == NULL)
- {
- return false;
- }
- parsed_name_len = ble_advdata_search(p_encoded_data,
- data_len,
- &data_offset,
- BLE_GAP_AD_TYPE_COMPLETE_LOCAL_NAME);
- p_parsed_name = &p_encoded_data[data_offset];
- if ( (data_offset != 0)
- && (parsed_name_len != 0)
- && (strlen(p_target_name) == parsed_name_len)
- && (memcmp(p_target_name, p_parsed_name, parsed_name_len) == 0))
- {
- return true;
- }
- return false;
- }
- bool ble_advdata_short_name_find(uint8_t const * p_encoded_data,
- uint16_t data_len,
- char const * p_target_name,
- uint8_t const short_name_min_len)
- {
- uint16_t parsed_name_len;
- uint8_t const * p_parsed_name;
- uint16_t data_offset = 0;
- if (p_target_name == NULL)
- {
- return false;
- }
- parsed_name_len = ble_advdata_search(p_encoded_data,
- data_len,
- &data_offset,
- BLE_GAP_AD_TYPE_SHORT_LOCAL_NAME);
- p_parsed_name = &p_encoded_data[data_offset];
- if ( (data_offset != 0)
- && (parsed_name_len != 0)
- && (parsed_name_len >= short_name_min_len)
- && (parsed_name_len < strlen(p_target_name))
- && (memcmp(p_target_name, p_parsed_name, parsed_name_len) == 0))
- {
- return true;
- }
- return false;
- }
- bool ble_advdata_uuid_find(uint8_t const * p_encoded_data,
- uint16_t data_len,
- ble_uuid_t const * p_target_uuid)
- {
- ret_code_t err_code;
- uint16_t data_offset = 0;
- uint8_t raw_uuid_len = UUID128_SIZE;
- uint8_t const * p_parsed_uuid;
- uint16_t parsed_uuid_len = data_len;
- uint8_t raw_uuid[UUID128_SIZE];
- uint8_t ad_types[N_AD_TYPES];
- err_code = sd_ble_uuid_encode(p_target_uuid, &raw_uuid_len, raw_uuid);
- if ((p_encoded_data == NULL) || (err_code != NRF_SUCCESS))
- {
-
- return false;
- }
- switch (raw_uuid_len)
- {
- case UUID16_SIZE:
- ad_types[0] = BLE_GAP_AD_TYPE_16BIT_SERVICE_UUID_COMPLETE;
- ad_types[1] = BLE_GAP_AD_TYPE_16BIT_SERVICE_UUID_MORE_AVAILABLE;
- break;
- case UUID32_SIZE:
-
- ad_types[0] = BLE_GAP_AD_TYPE_32BIT_SERVICE_UUID_COMPLETE;
- ad_types[1] = BLE_GAP_AD_TYPE_32BIT_SERVICE_UUID_MORE_AVAILABLE;
- break;
- case UUID128_SIZE:
- ad_types[0] = BLE_GAP_AD_TYPE_128BIT_SERVICE_UUID_COMPLETE;
- ad_types[1] = BLE_GAP_AD_TYPE_128BIT_SERVICE_UUID_MORE_AVAILABLE;
- break;
- default:
- return false;
- }
- for (uint8_t i = 0; (i < N_AD_TYPES) && (data_offset == 0); i++)
- {
- parsed_uuid_len = ble_advdata_search(p_encoded_data, data_len, &data_offset, ad_types[i]);
- }
- if (data_offset == 0)
- {
-
- return false;
- }
- p_parsed_uuid = &p_encoded_data[data_offset];
-
- for (uint16_t list_offset = 0; list_offset < parsed_uuid_len; list_offset += raw_uuid_len)
- {
- if (memcmp(&p_parsed_uuid[list_offset], raw_uuid, raw_uuid_len) == 0)
- {
- return true;
- }
- }
-
- return false;
- }
- bool ble_advdata_appearance_find(uint8_t const * p_encoded_data,
- uint16_t data_len,
- uint16_t const * p_target_appearance)
- {
- uint16_t data_offset = 0;
- uint8_t appearance_len;
- uint16_t decoded_appearance;
- appearance_len = ble_advdata_search(p_encoded_data, data_len, &data_offset, BLE_GAP_AD_TYPE_APPEARANCE);
- if ( (data_offset == 0)
- || (p_target_appearance == NULL)
- || (appearance_len == 0))
- {
-
- return false;
- }
- decoded_appearance = uint16_decode(&p_encoded_data[data_offset]);
- if (decoded_appearance == *p_target_appearance)
- {
- return true;
- }
-
- return false;
- }
|