/**@brief Function for adding the accel Level characteristic. * * @param[in] p_acc accel Service structure. * @param[in] p_acc_init Information needed to initialize the service. * * @return NRF_SUCCESS on success, otherwise an error code. */ static uint32_t accel_level_char_add(ble_acc_t * p_acc, const ble_acc_init_t * p_acc_init) { uint32_t err_code; ble_gatts_char_md_t char_md; ble_gatts_attr_md_t cccd_md; ble_gatts_attr_t attr_char_value; // ble_gatts_attr_t attr_char_value_2; ble_uuid_t ble_uuid; ble_gatts_attr_md_t attr_md; // ble_gatts_attr_md_t attr_md_2; ble_gatts_attr_md_t user_desc_md; ble_gatts_char_pf_t accel_pf; uint8_t initial_accel_level; uint8_t encoded_report_ref[BLE_SRV_ENCODED_REPORT_REF_LEN]; uint8_t init_len; uint8_t user_desc[] = "ACCEL"; // Add accel Level characteristic if (p_acc->is_notification_supported) { memset(&cccd_md, 0, sizeof(cccd_md)); // According to acc_SPEC_V10, the read operation on cccd should be possible without // authentication. BLE_GAP_CONN_SEC_MODE_SET_OPEN(&cccd_md.read_perm); cccd_md.write_perm = p_acc_init->accel_level_char_attr_md.cccd_write_perm; cccd_md.vloc = BLE_GATTS_VLOC_STACK; } memset(&user_desc_md, 0, sizeof(user_desc_md)); BLE_GAP_CONN_SEC_MODE_SET_OPEN(&user_desc_md.read_perm); // BLE_GAP_CONN_SEC_MODE_SET_OPEN(&user_desc_md.write_perm); user_desc_md.vloc = BLE_GATTS_VLOC_STACK; memset(&accel_pf, 0, sizeof(accel_pf)); accel_pf.format = BLE_GATT_CPF_FORMAT_UINT16; accel_pf.exponent = 0; accel_pf.unit = 0x2713; //acceleration data memset(&char_md, 0, sizeof(char_md)); char_md.char_props.read = 1; char_md.char_props.write = 1; char_md.char_props.notify = (p_acc->is_notification_supported) ? 1 : 0; char_md.p_char_user_desc = user_desc; char_md.char_user_desc_max_size = 6; char_md.char_user_desc_size = 6; char_md.p_char_pf = &accel_pf; char_md.p_user_desc_md = &user_desc_md; char_md.p_cccd_md = (p_acc->is_notification_supported) ? &cccd_md : NULL; char_md.p_sccd_md = NULL; //adds the acce id to the softdevice stack, puts a reference to where it is //into acc_uuid_type ble_uuid.type = p_acc->uuid_type; ble_uuid.uuid = BLE_UUID_TYPE_VENDOR_BEGIN; memset(&attr_md, 0, sizeof(attr_md)); attr_md.read_perm = p_acc_init->accel_level_char_attr_md.read_perm; attr_md.write_perm = p_acc_init->accel_level_char_attr_md.write_perm; attr_md.vloc = BLE_GATTS_VLOC_STACK; attr_md.rd_auth = 0; attr_md.wr_auth = 0; attr_md.vlen = 0; initial_accel_level = p_acc_init->initial_batt_level; memset(&attr_char_value, 0, sizeof(attr_char_value)); attr_char_value.p_uuid = &ble_uuid; attr_char_value.p_attr_md = &attr_md; attr_char_value.init_len = sizeof(uint16_t); attr_char_value.init_offs = 0; attr_char_value.max_len = sizeof(uint16_t); attr_char_value.p_value = &initial_accel_level; err_code = sd_ble_gatts_characteristic_add(p_acc->service_handle, &char_md, &attr_char_value, &p_acc->accel_level_handles); if (err_code != NRF_SUCCESS) { return err_code; } if (p_acc_init->p_report_ref != NULL) { // Add Report Reference descriptor BLE_UUID_BLE_ASSIGN(ble_uuid, BLE_UUID_REPORT_REF_DESCR); memset(&attr_md, 0, sizeof(attr_md)); attr_md.read_perm = p_acc_init->accel_level_report_read_perm; BLE_GAP_CONN_SEC_MODE_SET_NO_ACCESS(&attr_md.write_perm); attr_md.vloc = BLE_GATTS_VLOC_STACK; attr_md.rd_auth = 0; attr_md.wr_auth = 0; attr_md.vlen = 0; init_len = ble_srv_report_ref_encode(encoded_report_ref, p_acc_init->p_report_ref); memset(&attr_char_value, 0, sizeof(attr_char_value)); attr_char_value.p_uuid = &ble_uuid; attr_char_value.p_attr_md = &attr_md; attr_char_value.init_len = init_len; attr_char_value.init_offs = 0; attr_char_value.max_len = attr_char_value.init_len; attr_char_value.p_value = encoded_report_ref; err_code = sd_ble_gatts_descriptor_add(p_acc->accel_level_handles.value_handle, &attr_char_value, &p_acc->report_ref_handle); if (err_code != NRF_SUCCESS) { return err_code; } } else { p_acc->report_ref_handle = BLE_GATT_HANDLE_INVALID; } return NRF_SUCCESS; }
/**@brief Function for adding the Battery Level characteristic. * * @param[in] p_bas Battery Service structure. * @param[in] p_bas_init Information needed to initialize the service. * * @return NRF_SUCCESS on success, otherwise an error code. */ static uint32_t battery_level_char_add(ble_bas_t * p_bas, const ble_bas_init_t * p_bas_init) { uint32_t err_code; ble_gatts_char_md_t char_md; ble_gatts_attr_md_t cccd_md; ble_gatts_attr_t attr_char_value; ble_uuid_t ble_uuid; ble_gatts_attr_md_t attr_md; uint8_t initial_battery_level; uint8_t encoded_report_ref[BLE_SRV_ENCODED_REPORT_REF_LEN]; uint8_t init_len; // Add Battery Level characteristic if (p_bas->is_notification_supported) { memset(&cccd_md, 0, sizeof(cccd_md)); // According to BAS_SPEC_V10, the read operation on cccd should be possible without // authentication. BLE_GAP_CONN_SEC_MODE_SET_OPEN(&cccd_md.read_perm); cccd_md.write_perm = p_bas_init->battery_level_char_attr_md.cccd_write_perm; cccd_md.vloc = BLE_GATTS_VLOC_STACK; } memset(&char_md, 0, sizeof(char_md)); char_md.char_props.read = 1; char_md.char_props.notify = (p_bas->is_notification_supported) ? 1 : 0; char_md.p_char_user_desc = NULL; char_md.p_char_pf = NULL; char_md.p_user_desc_md = NULL; char_md.p_cccd_md = (p_bas->is_notification_supported) ? &cccd_md : NULL; char_md.p_sccd_md = NULL; BLE_UUID_BLE_ASSIGN(ble_uuid, BLE_UUID_BATTERY_LEVEL_CHAR); memset(&attr_md, 0, sizeof(attr_md)); attr_md.read_perm = p_bas_init->battery_level_char_attr_md.read_perm; attr_md.write_perm = p_bas_init->battery_level_char_attr_md.write_perm; attr_md.vloc = BLE_GATTS_VLOC_STACK; attr_md.rd_auth = 0; attr_md.wr_auth = 0; attr_md.vlen = 0; initial_battery_level = p_bas_init->initial_batt_level; memset(&attr_char_value, 0, sizeof(attr_char_value)); attr_char_value.p_uuid = &ble_uuid; attr_char_value.p_attr_md = &attr_md; attr_char_value.init_len = sizeof(uint8_t); attr_char_value.init_offs = 0; attr_char_value.max_len = sizeof(uint8_t); attr_char_value.p_value = &initial_battery_level; err_code = sd_ble_gatts_characteristic_add(p_bas->service_handle, &char_md, &attr_char_value, &p_bas->battery_level_handles); if (err_code != NRF_SUCCESS) { return err_code; } if (p_bas_init->p_report_ref != NULL) { // Add Report Reference descriptor BLE_UUID_BLE_ASSIGN(ble_uuid, BLE_UUID_REPORT_REF_DESCR); memset(&attr_md, 0, sizeof(attr_md)); attr_md.read_perm = p_bas_init->battery_level_report_read_perm; BLE_GAP_CONN_SEC_MODE_SET_NO_ACCESS(&attr_md.write_perm); attr_md.vloc = BLE_GATTS_VLOC_STACK; attr_md.rd_auth = 0; attr_md.wr_auth = 0; attr_md.vlen = 0; init_len = ble_srv_report_ref_encode(encoded_report_ref, p_bas_init->p_report_ref); memset(&attr_char_value, 0, sizeof(attr_char_value)); attr_char_value.p_uuid = &ble_uuid; attr_char_value.p_attr_md = &attr_md; attr_char_value.init_len = init_len; attr_char_value.init_offs = 0; attr_char_value.max_len = attr_char_value.init_len; attr_char_value.p_value = encoded_report_ref; err_code = sd_ble_gatts_descriptor_add(p_bas->battery_level_handles.value_handle, &attr_char_value, &p_bas->report_ref_handle); if (err_code != NRF_SUCCESS) { return err_code; } } else { p_bas->report_ref_handle = BLE_GATT_HANDLE_INVALID; } return NRF_SUCCESS; }
/**@brief Function for adding report characteristics. * * @param[in] p_hids HID Service structure. * @param[in] p_properties Report characteristic properties. * @param[in] max_len Maximum length of report value. * @param[in] p_rep_ref Report Reference descriptor. * @param[in] p_rep_ref_attr_md Characteristic security settings. * @param[in] is_read_resp Characteristic read authorization. * @param[out] p_rep_char Handles of new characteristic. * * @return NRF_SUCCESS on success, otherwise an error code. */ static uint32_t rep_char_add(ble_hids_t * p_hids, ble_gatt_char_props_t * p_properties, uint16_t max_len, ble_srv_report_ref_t * p_rep_ref, ble_srv_cccd_security_mode_t * p_rep_ref_attr_md, bool is_read_resp, ble_hids_rep_char_t * p_rep_char) { uint32_t err_code; ble_gatts_char_md_t char_md; ble_gatts_attr_md_t cccd_md; ble_gatts_attr_t attr_char_value; ble_uuid_t ble_uuid; ble_gatts_attr_md_t attr_md; uint8_t encoded_rep_ref[BLE_SRV_ENCODED_REPORT_REF_LEN]; // Add Report characteristic if (p_properties->notify) { memset(&cccd_md, 0, sizeof(cccd_md)); BLE_GAP_CONN_SEC_MODE_SET_OPEN(&cccd_md.read_perm); cccd_md.write_perm = p_rep_ref_attr_md->cccd_write_perm; cccd_md.vloc = BLE_GATTS_VLOC_STACK; } memset(&char_md, 0, sizeof(char_md)); char_md.char_props = *p_properties; char_md.p_char_user_desc = NULL; char_md.p_char_pf = NULL; char_md.p_user_desc_md = NULL; char_md.p_cccd_md = (p_properties->notify) ? &cccd_md : NULL; char_md.p_sccd_md = NULL; BLE_UUID_BLE_ASSIGN(ble_uuid, BLE_UUID_REPORT_CHAR); memset(&attr_md, 0, sizeof(attr_md)); attr_md.read_perm = p_rep_ref_attr_md->read_perm; attr_md.write_perm = p_rep_ref_attr_md->write_perm; attr_md.vloc = BLE_GATTS_VLOC_STACK; attr_md.rd_auth = is_read_resp ? 1 : 0; attr_md.wr_auth = 0; attr_md.vlen = 1; memset(&attr_char_value, 0, sizeof(attr_char_value)); attr_char_value.p_uuid = &ble_uuid; attr_char_value.p_attr_md = &attr_md; attr_char_value.init_len = 0; attr_char_value.init_offs = 0; attr_char_value.max_len = max_len; attr_char_value.p_value = NULL; err_code = sd_ble_gatts_characteristic_add(p_hids->service_handle, &char_md, &attr_char_value, &p_rep_char->char_handles); if (err_code != NRF_SUCCESS) { return err_code; } // Add Report Reference descriptor BLE_UUID_BLE_ASSIGN(ble_uuid, BLE_UUID_REPORT_REF_DESCR); memset(&attr_md, 0, sizeof(attr_md)); attr_md.read_perm = p_rep_ref_attr_md->read_perm; attr_md.write_perm = p_rep_ref_attr_md->write_perm; attr_md.vloc = BLE_GATTS_VLOC_STACK; attr_md.rd_auth = 0; attr_md.wr_auth = 0; attr_md.vlen = 0; memset(&attr_char_value, 0, sizeof(attr_char_value)); attr_char_value.p_uuid = &ble_uuid; attr_char_value.p_attr_md = &attr_md; attr_char_value.init_len = ble_srv_report_ref_encode(encoded_rep_ref, p_rep_ref); attr_char_value.init_offs = 0; attr_char_value.max_len = attr_char_value.init_len; attr_char_value.p_value = encoded_rep_ref; return sd_ble_gatts_descriptor_add(p_rep_char->char_handles.value_handle, &attr_char_value, &p_rep_char->ref_handle); }