123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280 |
- #include "sdk_common.h"
- #if NRF_MODULE_ENABLED(BLE_DIS)
- #include "ble_dis.h"
- #include <stdlib.h>
- #include <string.h>
- #include "app_error.h"
- #include "ble_gatts.h"
- #include "ble_srv_common.h"
- #define BLE_DIS_SYS_ID_LEN 8
- #define BLE_DIS_PNP_ID_LEN 7
- static uint16_t service_handle;
- static ble_gatts_char_handles_t manufact_name_handles;
- static ble_gatts_char_handles_t model_num_handles;
- static ble_gatts_char_handles_t serial_num_handles;
- static ble_gatts_char_handles_t hw_rev_handles;
- static ble_gatts_char_handles_t fw_rev_handles;
- static ble_gatts_char_handles_t sw_rev_handles;
- static ble_gatts_char_handles_t sys_id_handles;
- static ble_gatts_char_handles_t reg_cert_data_list_handles;
- static ble_gatts_char_handles_t pnp_id_handles;
- static void sys_id_encode(uint8_t * p_encoded_buffer, ble_dis_sys_id_t const * p_sys_id)
- {
- APP_ERROR_CHECK_BOOL(p_sys_id != NULL);
- APP_ERROR_CHECK_BOOL(p_encoded_buffer != NULL);
- p_encoded_buffer[0] = (p_sys_id->manufacturer_id & 0x00000000FF);
- p_encoded_buffer[1] = (p_sys_id->manufacturer_id & 0x000000FF00) >> 8;
- p_encoded_buffer[2] = (p_sys_id->manufacturer_id & 0x0000FF0000) >> 16;
- p_encoded_buffer[3] = (p_sys_id->manufacturer_id & 0x00FF000000) >> 24;
- p_encoded_buffer[4] = (p_sys_id->manufacturer_id & 0xFF00000000) >> 32;
- p_encoded_buffer[5] = (p_sys_id->organizationally_unique_id & 0x0000FF);
- p_encoded_buffer[6] = (p_sys_id->organizationally_unique_id & 0x00FF00) >> 8;
- p_encoded_buffer[7] = (p_sys_id->organizationally_unique_id & 0xFF0000) >> 16;
- }
- static void pnp_id_encode(uint8_t * p_encoded_buffer, ble_dis_pnp_id_t const * p_pnp_id)
- {
- uint8_t len = 0;
- APP_ERROR_CHECK_BOOL(p_pnp_id != NULL);
- APP_ERROR_CHECK_BOOL(p_encoded_buffer != NULL);
- p_encoded_buffer[len++] = p_pnp_id->vendor_id_source;
- len += uint16_encode(p_pnp_id->vendor_id, &p_encoded_buffer[len]);
- len += uint16_encode(p_pnp_id->product_id, &p_encoded_buffer[len]);
- len += uint16_encode(p_pnp_id->product_version, &p_encoded_buffer[len]);
- APP_ERROR_CHECK_BOOL(len == BLE_DIS_PNP_ID_LEN);
- }
- static uint32_t char_add(uint16_t uuid,
- uint8_t * p_char_value,
- uint16_t char_len,
- security_req_t const rd_sec,
- ble_gatts_char_handles_t * p_handles)
- {
- ble_add_char_params_t add_char_params;
- APP_ERROR_CHECK_BOOL(p_char_value != NULL);
- APP_ERROR_CHECK_BOOL(char_len > 0);
- memset(&add_char_params, 0, sizeof(add_char_params));
- add_char_params.uuid = uuid;
- add_char_params.max_len = char_len;
- add_char_params.init_len = char_len;
- add_char_params.p_init_value = p_char_value;
- add_char_params.char_props.read = 1;
- add_char_params.read_access = rd_sec;
- return characteristic_add(service_handle, &add_char_params, p_handles);
- }
- uint32_t ble_dis_init(ble_dis_init_t const * p_dis_init)
- {
- uint32_t err_code;
- ble_uuid_t ble_uuid;
-
- BLE_UUID_BLE_ASSIGN(ble_uuid, BLE_UUID_DEVICE_INFORMATION_SERVICE);
- err_code = sd_ble_gatts_service_add(BLE_GATTS_SRVC_TYPE_PRIMARY, &ble_uuid, &service_handle);
- if (err_code != NRF_SUCCESS)
- {
- return err_code;
- }
-
- if (p_dis_init->manufact_name_str.length > 0)
- {
- err_code = char_add(BLE_UUID_MANUFACTURER_NAME_STRING_CHAR,
- p_dis_init->manufact_name_str.p_str,
- p_dis_init->manufact_name_str.length,
- p_dis_init->dis_char_rd_sec,
- &manufact_name_handles);
- if (err_code != NRF_SUCCESS)
- {
- return err_code;
- }
- }
- if (p_dis_init->model_num_str.length > 0)
- {
- err_code = char_add(BLE_UUID_MODEL_NUMBER_STRING_CHAR,
- p_dis_init->model_num_str.p_str,
- p_dis_init->model_num_str.length,
- p_dis_init->dis_char_rd_sec,
- &model_num_handles);
- if (err_code != NRF_SUCCESS)
- {
- return err_code;
- }
- }
- if (p_dis_init->serial_num_str.length > 0)
- {
- err_code = char_add(BLE_UUID_SERIAL_NUMBER_STRING_CHAR,
- p_dis_init->serial_num_str.p_str,
- p_dis_init->serial_num_str.length,
- p_dis_init->dis_char_rd_sec,
- &serial_num_handles);
- if (err_code != NRF_SUCCESS)
- {
- return err_code;
- }
- }
- if (p_dis_init->hw_rev_str.length > 0)
- {
- err_code = char_add(BLE_UUID_HARDWARE_REVISION_STRING_CHAR,
- p_dis_init->hw_rev_str.p_str,
- p_dis_init->hw_rev_str.length,
- p_dis_init->dis_char_rd_sec,
- &hw_rev_handles);
- if (err_code != NRF_SUCCESS)
- {
- return err_code;
- }
- }
- if (p_dis_init->fw_rev_str.length > 0)
- {
- err_code = char_add(BLE_UUID_FIRMWARE_REVISION_STRING_CHAR,
- p_dis_init->fw_rev_str.p_str,
- p_dis_init->fw_rev_str.length,
- p_dis_init->dis_char_rd_sec,
- &fw_rev_handles);
- if (err_code != NRF_SUCCESS)
- {
- return err_code;
- }
- }
- if (p_dis_init->sw_rev_str.length > 0)
- {
- err_code = char_add(BLE_UUID_SOFTWARE_REVISION_STRING_CHAR,
- p_dis_init->sw_rev_str.p_str,
- p_dis_init->sw_rev_str.length,
- p_dis_init->dis_char_rd_sec,
- &sw_rev_handles);
- if (err_code != NRF_SUCCESS)
- {
- return err_code;
- }
- }
- if (p_dis_init->p_sys_id != NULL)
- {
- uint8_t encoded_sys_id[BLE_DIS_SYS_ID_LEN];
- sys_id_encode(encoded_sys_id, p_dis_init->p_sys_id);
- err_code = char_add(BLE_UUID_SYSTEM_ID_CHAR,
- encoded_sys_id,
- BLE_DIS_SYS_ID_LEN,
- p_dis_init->dis_char_rd_sec,
- &sys_id_handles);
- if (err_code != NRF_SUCCESS)
- {
- return err_code;
- }
- }
- if (p_dis_init->p_reg_cert_data_list != NULL)
- {
- err_code = char_add(BLE_UUID_IEEE_REGULATORY_CERTIFICATION_DATA_LIST_CHAR,
- p_dis_init->p_reg_cert_data_list->p_list,
- p_dis_init->p_reg_cert_data_list->list_len,
- p_dis_init->dis_char_rd_sec,
- ®_cert_data_list_handles);
- if (err_code != NRF_SUCCESS)
- {
- return err_code;
- }
- }
- if (p_dis_init->p_pnp_id != NULL)
- {
- uint8_t encoded_pnp_id[BLE_DIS_PNP_ID_LEN];
- pnp_id_encode(encoded_pnp_id, p_dis_init->p_pnp_id);
- err_code = char_add(BLE_UUID_PNP_ID_CHAR,
- encoded_pnp_id,
- BLE_DIS_PNP_ID_LEN,
- p_dis_init->dis_char_rd_sec,
- &pnp_id_handles);
- if (err_code != NRF_SUCCESS)
- {
- return err_code;
- }
- }
- return NRF_SUCCESS;
- }
- #endif
|