198 lines
7.2 KiB
C
198 lines
7.2 KiB
C
/* Copyright (c) 2012 Nordic Semiconductor. All Rights Reserved.
|
||
*
|
||
* The information contained herein is property of Nordic Semiconductor ASA.
|
||
* Terms and conditions of usage are described in detail in NORDIC
|
||
* SEMICONDUCTOR STANDARD SOFTWARE LICENSE AGREEMENT.
|
||
*
|
||
* Licensees are granted free, non-transferable use of the information. NO
|
||
* WARRANTY of ANY KIND is provided. This heading must NOT be removed from
|
||
* the file.
|
||
*
|
||
*/
|
||
|
||
/* Attention!
|
||
* To maintain compliance with Nordic Semiconductor ASA’s Bluetooth profile
|
||
* qualification listings, this section of source code must not be modified.
|
||
*/
|
||
|
||
#include "ble_srv_common.h"
|
||
#include <string.h>
|
||
#include "nordic_common.h"
|
||
#include "app_error.h"
|
||
#include "ble.h"
|
||
|
||
uint8_t ble_srv_report_ref_encode(uint8_t * p_encoded_buffer,
|
||
const ble_srv_report_ref_t * p_report_ref)
|
||
{
|
||
uint8_t len = 0;
|
||
|
||
p_encoded_buffer[len++] = p_report_ref->report_id;
|
||
p_encoded_buffer[len++] = p_report_ref->report_type;
|
||
|
||
APP_ERROR_CHECK_BOOL(len == BLE_SRV_ENCODED_REPORT_REF_LEN);
|
||
return len;
|
||
}
|
||
|
||
|
||
void ble_srv_ascii_to_utf8(ble_srv_utf8_str_t * p_utf8, char * p_ascii)
|
||
{
|
||
p_utf8->length = (uint16_t)strlen(p_ascii);
|
||
p_utf8->p_str = (uint8_t *)p_ascii;
|
||
}
|
||
|
||
|
||
/**@brief Function for setting security requirements of a characteristic.
|
||
*
|
||
* @param[in] level required security level.
|
||
* @param[out] p_perm Characteristic security requirements.
|
||
*
|
||
* @return encoded security level and security mode.
|
||
*/
|
||
static inline void set_security_req(security_req_t level, ble_gap_conn_sec_mode_t * p_perm)
|
||
{
|
||
|
||
|
||
BLE_GAP_CONN_SEC_MODE_SET_NO_ACCESS(p_perm);
|
||
switch (level)
|
||
{
|
||
case SEC_NO_ACCESS:
|
||
BLE_GAP_CONN_SEC_MODE_SET_NO_ACCESS(p_perm);
|
||
break;
|
||
case SEC_OPEN:
|
||
BLE_GAP_CONN_SEC_MODE_SET_OPEN(p_perm);
|
||
break;
|
||
case SEC_JUST_WORKS:
|
||
BLE_GAP_CONN_SEC_MODE_SET_ENC_NO_MITM(p_perm);
|
||
break;
|
||
case SEC_MITM:
|
||
BLE_GAP_CONN_SEC_MODE_SET_ENC_WITH_MITM(p_perm);
|
||
break;
|
||
case SEC_SIGNED:
|
||
BLE_GAP_CONN_SEC_MODE_SET_SIGNED_NO_MITM(p_perm);
|
||
break;
|
||
case SEC_SIGNED_MITM:
|
||
BLE_GAP_CONN_SEC_MODE_SET_SIGNED_WITH_MITM(p_perm);
|
||
break;
|
||
}
|
||
return;
|
||
}
|
||
|
||
|
||
uint32_t characteristic_add(uint16_t service_handle,
|
||
ble_add_char_params_t * p_char_props,
|
||
ble_gatts_char_handles_t * p_char_handle)
|
||
{
|
||
ble_gatts_char_md_t char_md;
|
||
ble_gatts_attr_t attr_char_value;
|
||
ble_uuid_t char_uuid;
|
||
ble_gatts_attr_md_t attr_md;
|
||
ble_gatts_attr_md_t user_descr_attr_md;
|
||
ble_gatts_attr_md_t cccd_md;
|
||
|
||
if (p_char_props->uuid_type == 0)
|
||
{
|
||
char_uuid.type = BLE_UUID_TYPE_BLE;
|
||
}
|
||
else
|
||
{
|
||
char_uuid.type = p_char_props->uuid_type;
|
||
}
|
||
char_uuid.uuid = p_char_props->uuid;
|
||
|
||
memset(&attr_md, 0, sizeof(ble_gatts_attr_md_t));
|
||
set_security_req(p_char_props->read_access, &attr_md.read_perm);
|
||
set_security_req(p_char_props->write_access, & attr_md.write_perm);
|
||
attr_md.rd_auth = (p_char_props->is_defered_read ? 1 : 0);
|
||
attr_md.wr_auth = (p_char_props->is_defered_write ? 1 : 0);
|
||
attr_md.vlen = (p_char_props->is_var_len ? 1 : 0);
|
||
attr_md.vloc = (p_char_props->is_value_user ? BLE_GATTS_VLOC_USER : BLE_GATTS_VLOC_STACK);
|
||
|
||
|
||
memset(&char_md, 0, sizeof(ble_gatts_char_md_t));
|
||
if ((p_char_props->char_props.notify == 1)||(p_char_props->char_props.indicate == 1))
|
||
{
|
||
|
||
memset(&cccd_md, 0, sizeof(cccd_md));
|
||
set_security_req(p_char_props->cccd_write_access, &cccd_md.write_perm);
|
||
BLE_GAP_CONN_SEC_MODE_SET_OPEN(&cccd_md.read_perm);
|
||
|
||
cccd_md.vloc = BLE_GATTS_VLOC_STACK;
|
||
|
||
char_md.p_cccd_md = &cccd_md;
|
||
}
|
||
char_md.char_props = p_char_props->char_props;
|
||
|
||
memset(&attr_char_value, 0, sizeof(ble_gatts_attr_t));
|
||
attr_char_value.p_uuid = &char_uuid;
|
||
attr_char_value.p_attr_md = &attr_md;
|
||
attr_char_value.max_len = p_char_props->max_len;
|
||
if (p_char_props->p_init_value != NULL)
|
||
{
|
||
attr_char_value.init_len = p_char_props->init_len;
|
||
attr_char_value.p_value = p_char_props->p_init_value;
|
||
}
|
||
if (p_char_props->p_user_descr != NULL)
|
||
{
|
||
memset(&user_descr_attr_md, 0, sizeof(ble_gatts_attr_md_t));
|
||
char_md.char_user_desc_max_size = p_char_props->p_user_descr->max_size;
|
||
char_md.char_user_desc_size = p_char_props->p_user_descr->size;
|
||
char_md.p_char_user_desc = p_char_props->p_user_descr->p_char_user_desc;
|
||
|
||
char_md.p_user_desc_md = &user_descr_attr_md;
|
||
|
||
set_security_req(p_char_props->p_user_descr->read_access, &user_descr_attr_md.read_perm);
|
||
set_security_req(p_char_props->p_user_descr->write_access, &user_descr_attr_md.write_perm);
|
||
|
||
user_descr_attr_md.rd_auth = (p_char_props->p_user_descr->is_defered_read ? 1 : 0);
|
||
user_descr_attr_md.wr_auth = (p_char_props->p_user_descr->is_defered_write ? 1 : 0);
|
||
user_descr_attr_md.vlen = (p_char_props->p_user_descr->is_var_len ? 1 : 0);
|
||
user_descr_attr_md.vloc = (p_char_props->p_user_descr->is_value_user ? BLE_GATTS_VLOC_USER : BLE_GATTS_VLOC_STACK);
|
||
}
|
||
if (p_char_props->p_presentation_format != NULL)
|
||
{
|
||
char_md.p_char_pf = p_char_props->p_presentation_format;
|
||
}
|
||
return sd_ble_gatts_characteristic_add(service_handle,
|
||
&char_md,
|
||
&attr_char_value,
|
||
p_char_handle);
|
||
}
|
||
|
||
|
||
uint32_t descriptor_add(uint16_t char_handle,
|
||
ble_add_descr_params_t * p_descr_props,
|
||
uint16_t * p_descr_handle)
|
||
{
|
||
ble_gatts_attr_t descr_params;
|
||
ble_uuid_t desc_uuid;
|
||
ble_gatts_attr_md_t attr_md;
|
||
|
||
memset(&descr_params, 0, sizeof(descr_params));
|
||
if (p_descr_props->uuid_type == 0)
|
||
{
|
||
desc_uuid.type = BLE_UUID_TYPE_BLE;
|
||
}
|
||
else
|
||
{
|
||
desc_uuid.type = p_descr_props->uuid_type;
|
||
}
|
||
desc_uuid.uuid = p_descr_props->uuid;
|
||
descr_params.p_uuid = &desc_uuid;
|
||
|
||
set_security_req(p_descr_props->read_access, &attr_md.read_perm);
|
||
set_security_req(p_descr_props->write_access,&attr_md.write_perm);
|
||
|
||
attr_md.rd_auth = (p_descr_props->is_defered_read ? 1 : 0);
|
||
attr_md.wr_auth = (p_descr_props->is_defered_write ? 1 : 0);
|
||
attr_md.vlen = (p_descr_props->is_var_len ? 1 : 0);
|
||
attr_md.vloc = (p_descr_props->is_value_user ? BLE_GATTS_VLOC_USER : BLE_GATTS_VLOC_STACK);
|
||
descr_params.p_attr_md = &attr_md;
|
||
|
||
descr_params.init_len = p_descr_props->init_len;
|
||
descr_params.init_offs = p_descr_props->init_offs;
|
||
descr_params.max_len = p_descr_props->max_len;
|
||
descr_params.p_value = p_descr_props->p_value;
|
||
|
||
return sd_ble_gatts_descriptor_add(char_handle, &descr_params, p_descr_handle);
|
||
}
|