New Service Addition

Hi VesaN,

I am trying to add a write/read characteristic to the existing sample128.

/ **
****************************************************************************************
*
* @file sample128_task.c
*
* @brief sample128任务实现。
*
* @brief 128 uuid服务。示例代码
*
*版权所有（c）2013年对话半导体Gmb雷竞技电竞平台H及其关联公司，未发表的工作
* This computer program includes Confidential, Proprietary Information and is a Trade Secret
*对话半导雷竞技电竞平台体GmbH及其附属公司。所有使用，披露和/或
*除非授权书面授权，否则禁止复制。版权所有。
*
****************************************************************************************
* /

/ *
*包括文件
****************************************************************************************
* /

#include "rwble_config.h"

#if (BLE_SAMPLE128)

#include "gap.h"
#include“gapc.h”
#include“gattc_task.h”
#include "atts_util.h"
#include "sample128.h"
#include "sample128_task.h"
#include "attm_cfg.h"
#include“attm_db.h”
#include "prf_utils.h"

/ *
* FUNCTION DEFINITIONS
****************************************************************************************
* /

/ **
****************************************************************************************
* @brief Handles reception of the @ref SAMPLE128_CREATE_DB_REQ message.
* @param [in]收到的消息的msgid ID（可能未使用）。
* @param[in] param Pointer to the parameters of the message.
* @param[in] dest_id ID of the receiving task instance (probably unused).
* @param[in] src_id ID of the sending task instance.
* @return如果邮件被消耗或不。
****************************************************************************************
* /
static int sample128_create_db_req_handler(ke_msg_id_t const msgid,
struct sample128_create_db_req const *param,
ke_task_id_t const dest_id,
ke_task_id_t const src_id)
{
//数据库创建状态
uint8_t status;

uint8_t nb_att_16;
uint8_t nb_att_128;
uint8_t nb_att_32;
uint16_t att_decl_svc = ATT_DECL_PRIMARY_SERVICE;
uint16_t att_decl_char = ATT_DECL_CHARACTERISTIC;
uint16_t att_decl_cfg = ATT_DESC_CLIENT_CHAR_CFG;
uint16_t val_hdl;
uint16_t char_hdl;

//Save Profile ID
sample128_env.con_info.prf_id = TASK_SAMPLE128;

/ * --------------------------------------------- *
* Sample128 Service Creation
*---------------------------------------------------*/

//Add Service Into Database

nb_att_16 = 5; // 6...4 UUID16 Attribute declaration types
nb_att_32 = 0; // 0 UUID32 Attribute declaration types
nb_att_128 = 3;// 2 uuid128属性声明类型

status = attmdb_add_service（＆（sample128_env.sample128_shdl），
task_sample128，
nb_att_16,
nb_att_32，
nb_att_128,
78
);

if (status == ATT_ERR_NO_ERROR)
{
// Add the primary service attribute /////////////////////////////////////////////////////////////////
status = attmdb_add_attribute( sample128_env.sample128_shdl, // Attribute Handle
ATT_UUID_128_LEN, // Data size = 16 (ATT_UUID_128_LEN)
ATT_UUID_16_LEN, // Size of declaration type ID
（UINT8_T *）＆ATT_DECL_SVC，// 0x2800用于主要服务声明
PERM(RD, ENABLE), // Permissions
＆（sample128_env.sample128_shdl）//属性句柄
);

// Add the value of the primary service attribute (The custom UUID)
status = attmdb_att_set_value( sample128_env.sample128_shdl, // Attribute handle
ATT_UUID_128_LEN, // The value is the 128 bit UUID of the service
(uint8_t *)sample128_svc.uuid // UUID of the service
);

// Characterisitic 1: ////////////////////////////////////////////////////////////////////////////////

// Add characteristic declaration attribute to database
status = attmdb_add_attribute( sample128_env.sample128_shdl,
ATT_UUID_128_LEN + 3, // Data size = 19 (ATT_UUID_128_LEN + 3)
ATT_UUID_16_LEN, // Size of declaration type ID
(uint8_t*) &att_decl_char, // 0x2803 for a characteristic declaration
PERM(RD, ENABLE), // Permissions
&(char_hdl) // Handle to the characteristic declaration
);

// Add characteristic value declaration attribute to database
status = attmdb_add_attribute( sample128_env.sample128_shdl,
sizeof（uint8_t），// data size = 1字节
ATT_UUID_128_LEN,// Size of custom declaration type = 128bit
(uint8_t*)&sample128_1_val.uuid, // UUID of the characteristic value
perm（rd，启用）|perm（wr，启用），//权限
&(val_hdl) // handle to the value attribute
);

//存储特性1的值句柄1
memcpy(sample128_1_char.attr_hdl, &val_hdl, sizeof(uint16_t));

// Set initial value of characteristic 1
status = attmdb_att_set_value(char_hdl, sizeof(sample128_1_char), (uint8_t *)&sample128_1_char);

//特征2：/////////////////////////////////////////////////////////////////////////////////////////////

// Add characteristic declaration attribute to database
status = attmdb_add_attribute( sample128_env.sample128_shdl,
ATT_UUID_128_LEN + 3, //Data size = 19 (ATT_UUID_128_LEN + 3)
ATT_UUID_16_LEN,//Size of declaration type ID
(uint8_t*) &att_decl_char, // 0x2803 for a characteristic declaration
PERM(RD, ENABLE),// Permissions
&(char_hdl) // Handle to the characteristic declaration
);

// Add characteristic value declaration attribute to database
status = attmdb_add_attribute( sample128_env.sample128_shdl,
sizeof(uint8_t), //Data size = 1 Byte
ATT_UUID_128_LEN,// Size of custom declaration type ID = 128bit
(uint8_t*)&sample128_2_val.uuid, // UUID of the characteristic value
perm（rd，启用）|PERM(NTF, ENABLE),// Permissions
&(val_hdl) // Handle to the value attribute
);

//存储特性2的值句柄
memcpy(sample128_2_char.attr_hdl, &val_hdl, sizeof(uint16_t));

// Set initial value of characteristic 2
status = attmdb_att_set_value（char_hdl，sizeof（sample128_2_char），（uint8_t *）和sample128_2_char）;

// Add client configuration declaration attribute to database ( Facilitates Notify )
status = attmdb_add_attribute( sample128_env.sample128_shdl,
sizeof(uint16_t), // Data size 2bytes (16bit)
ATT_UUID_16_LEN, // Size of client configuration type ID
（UINT8_T *）＆ATT_DECL_CFG，// 0x2902客户端配置声明类型的UUID
perm（rd，启用）|PERM(WR, ENABLE), // Permissions
&(val_hdl) // Handle to value attribute
);

// writeitisit 3 for write：/////////////////////////////////////////////////////////////////////////////////////////

// Add characteristic declaration attribute to database
status = attmdb_add_attribute( sample128_env.sample128_shdl,
ATT_UUID_128_LEN + 3, // Data size = 19 (ATT_UUID_128_LEN + 3)
ATT_UUID_16_LEN, // Size of declaration type ID
(uint8_t*) &att_decl_char, // 0x2803 for a characteristic declaration
PERM(RD, ENABLE), // Permissions
&(char_hdl) // Handle to the characteristic declaration
);

// Add characteristic value declaration attribute to database
status = attmdb_add_attribute( sample128_env.sample128_shdl,
sizeof（my_newer_t），//数据大小= 1字节
ATT_UUID_128_LEN,// Size of custom declaration type = 128bit
(uint8_t*)&sample128_3_val.uuid, // UUID of the characteristic value
perm（rd，启用）|perm（wr，启用），//权限
&(val_hdl) // handle to the value attribute
);

//存储特征3的值句柄
memcpy(sample128_3_char.attr_hdl, &val_hdl, sizeof(uint16_t));

// Set initial value of characteristic 3
status = attmdb_att_set_value(char_hdl, sizeof(sample128_3_char), (uint8_t *)&sample128_3_char);

////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////

//Disable sample128 service
attmdb_svc_set_permission(sample128_env.sample128_shdl, PERM(SVC, DISABLE));

//If we are here, database has been fulfilled with success, go to idle state
ke_state_set(TASK_SAMPLE128, SAMPLE128_IDLE);
}

//Send CFM to application
struct sample128_create_db_cfm * cfm = KE_MSG_ALLOC(SAMPLE128_CREATE_DB_CFM, src_id,
task_sample128，sample128_create_db_cfm）;
cfm-> status = status;
ke_msg_send(cfm);

return (KE_MSG_CONSUMED);
}

/ **
****************************************************************************************
* @brief启用示例128角色，在连接后使用。
* @param[in] msgid Id of the message received.
* @param[in] param Pointer to the parameters of the message.
* @param[in] dest_id ID of the receiving task instance
* @param[in] src_id ID of the sending task instance.
* @return如果邮件被消耗或不。
****************************************************************************************
* /
静态int sample128_enable_req_handler（ke_msg_id_t const msgid，
struct sample128_enable_req const *param,
ke_task_id_t const dest_id,
ke_task_id_t const src_id)
{

uint16_t temp = 1;

// Keep source of message, to respond to it further on
sample128_env.con_info.appid = src_id;
// Store the connection handle for which this profile is enabled
sample128_env.con_info.conidx = gapc_get_conidx(param->conhdl);

//检查是否存在提供的连接
if（sample128_env.con_info.conidx == gap_invalid_conidx）
{
// The connection doesn't exist, request disallowed
prf_server_error_ind_send((prf_env_struct *)&sample128_env, PRF_ERR_REQ_DISALLOWED,
sample128_error_ind，sample128_enable_req）;
}
else
{
//示例128服务权限
attmdb_svc_set_permission(sample128_env.sample128_shdl, param->sec_lvl);

// Set characteristic 1 to specified value
attmdb_att_set_value(sample128_env.sample128_shdl + SAMPLE128_1_IDX_VAL,
sizeof(uint8_t), (uint8_t *)¶m->sample128_1_val);

//将特征2设置为指定值
attmdb_att_set_value（sample128_env.sample128_shdl + sample128_2_idx_val，
sizeof(uint8_t), (uint8_t *)¶m->sample128_2_val);

//将特征3设置为指定值
attmdb_att_set_value(sample128_env.sample128_shdl + SAMPLE128_3_IDX_VAL,
sizeof(uint8_t), (uint8_t *)¶m->sample128_3_val);

sample128_env.feature = param->feature;

if（！sample128_env.feature）
{
temp = 0;
}

attmdb_att_set_value(sample128_env.sample128_shdl + SAMPLE128_2_IDX_CFG,
sizeof(uint16_t), (uint8_t *)&temp);

// Go to Connected state
ke_state_set（task_sample128，sample128_connected）;
}

return (KE_MSG_CONSUMED);
}

/ **
****************************************************************************************
* @brief Updates value of characteristic 2. Sends notification to peer if property is enabled.
* @param[in] msgid Id of the message received.
* @param[in] param Pointer to the parameters of the message.
* @param[in] dest_id ID of the receiving task instance
* @param[in] src_id ID of the sending task instance.
* @return如果邮件被消耗或不。
****************************************************************************************
* /

static int sample128_upd_char2_req_handler(ke_msg_id_t const msgid,
struct sample128_upd_char2_req const *param,
ke_task_id_t const dest_id,
ke_task_id_t const src_id)
{
uint8_t status = PRF_ERR_OK;

// Check provided values
if(param->conhdl == gapc_get_conhdl(sample128_env.con_info.conidx))
{
// Update value in database
attmdb_att_set_value（sample128_env.sample128_shdl + sample128_2_idx_val，
sizeof(uint8_t), (uint8_t *)¶m->val);

if((sample128_env.feature & PRF_CLI_START_NTF))
// Send notification through GATT
prf_server_send_event((prf_env_struct *)&sample128_env, false,
sample128_env.sample128_shdl + sample128_2_idx_val）;

}
else
{
status = PRF_ERR_INVALID_PARAM;
}

if (status != PRF_ERR_OK)
{
sample128_upd_char2_cfm_send(status);
}

return (KE_MSG_CONSUMED);
}

/ **
****************************************************************************************
* @brief处理@ref gatt_write_cmd_ind消息的接收。
* @param [in]收到的消息的msgid ID（可能未使用）。
* @param[in] param Pointer to the parameters of the message.
* @param[in] dest_id ID of the receiving task instance (probably unused).
* @param[in] src_id ID of the sending task instance.
* @return如果邮件被消耗或不。
****************************************************************************************
* /
static int gattc_write_cmd_ind_handler(ke_msg_id_t const msgid,
struct gattc_write_cmd_ind const * param，
ke_task_id_t const dest_id,
ke_task_id_t const src_id)
{
uint8_t char_code = sample128_err_char;
uint8_t status = prf_app_error;

if (KE_IDX_GET(src_id) == sample128_env.con_info.conidx)
{
if (param->handle == sample128_env.sample128_shdl + SAMPLE128_1_IDX_VAL)
{
char_code = SAMPLE128_1_CHAR;
}

if (param->handle == sample128_env.sample128_shdl + SAMPLE128_2_IDX_CFG)
{
char_code = SAMPLE128_2_CFG;
}

if (param->handle == sample128_env.sample128_shdl + SAMPLE128_3_IDX_VAL)
{
char_code = SAMPLE128_3_CHAR;
}
if（char_code == sample128_1_char）
{

在DB / /保存价值
attmdb_att_set_value(param->handle, sizeof(uint8_t), (uint8_t *)¶m->value[0]);

if(param->last)
{
sample128_send_val(param->value[0]);
}

status = PRF_ERR_OK;

}
else if (char_code == SAMPLE128_2_CFG)
{

// Written value
uint16_t ntf_cfg;

// Extract value before check
ntf_cfg = co_read16p(¶m->value[0]);

// Only update configuration if value for stop or notification enable
if（（ntf_cfg == prf_cli_stop_ntfind）||（ntf_cfg == prf_cli_start_ntf））
{
在DB / /保存价值
attmdb_att_set_value(param->handle, sizeof(uint16_t), (uint8_t *)¶m->value[0]);

//保存环境中的信息
if (ntf_cfg == PRF_CLI_START_NTF)
{
// Ntf cfg bit set to 1
sample128_env.feature | = prf_cli_start_ntf;
}
else
{
// Ntf cfg bit set to 0
sample128_env.feature &= ~PRF_CLI_START_NTF;
}

status = PRF_ERR_OK;

}
}

否则if（char_code == sample128_3_char）
{

在DB / /保存价值
attmdb_att_set_value(param->handle, sizeof(uint8_t), (uint8_t *)¶m->value[0]);

if(param->last)
{
sample128_send_val(param->value[0]);
}

status = PRF_ERR_OK;

}
}

//发送写回复
ATTS_WRITE_RSP_SEND（Sample128_ENV.CON_INFO.CONIDX，PARAM->句柄，状态）;

return (KE_MSG_CONSUMED);
}

/ **
****************************************************************************************
* @brief Disconnection indication to sample128.
* @param[in] msgid Id of the message received.
* @param[in] param Pointer to the parameters of the message.
* @param[in] dest_id ID of the receiving task instance
* @param[in] src_id ID of the sending task instance.
* @return如果邮件被消耗或不。
****************************************************************************************
* /
static int gap_disconnnect_ind_handler(ke_msg_id_t const msgid,
struct gapc_disconnect_ind const * param，
ke_task_id_t const dest_id,
ke_task_id_t const src_id)
{

// Check Connection Handle
if (KE_IDX_GET(src_id) == sample128_env.con_info.conidx)
{

// In any case, inform APP about disconnection
sample128_disable();
}

return (KE_MSG_CONSUMED);
}

/ *
* GLOBAL VARIABLE DEFINITIONS
****************************************************************************************
* /

/// Disabled State handler definition.
const struct ke_msg_handler sample128_disabled[] =
{
{SAMPLE128_CREATE_DB_REQ, (ke_msg_func_t) sample128_create_db_req_handler },
{SAMPLE128_CREATE_DB_REQ3, (ke_msg_func_t) sample128_create_db_req_handler },
};

/// Idle State handler definition.
const struct ke_msg_handler sample128_idle[] =
{
{SAMPLE128_ENABLE_REQ, (ke_msg_func_t) sample128_enable_req_handler },

};

/// Connected State handler definition.
const struct ke_msg_handler sample128_connected[] =
{
{GATTC_WRITE_CMD_IND, (ke_msg_func_t) gattc_write_cmd_ind_handler},
{SAMPLE128_UPD_CHAR2_REQ, (ke_msg_func_t) sample128_upd_char2_req_handler},
{GATTC_WRITE_CMD_IND3, gattc_write (ke_msg_func_t)_cmd_ind_handler3},

};

/// Default State handlers definition
const struct ke_msg_handler sample128_default_state [] =
{
{GAPC_DISCONNECT_IND, (ke_msg_func_t) gap_disconnnect_ind_handler},
};

/// Specifies the message handler structure for every input state.
const struct ke_state_handler sample128_state_handler [sample128_state_max] =
{
[sample128_disabled] = ke_state_handler（sample128_disabled），
[SAMPLE128_IDLE] = KE_STATE_HANDLER(sample128_idle),
[SAMPLE128_CONNECTED] = KE_STATE_HANDLER(sample128_connected),
};

/// Specifies the message handlers that are common to all states.
const struct ke_state_handler sample128_default_handler = KE_STATE_HANDLER(sample128_default_state);

/// Defines the place holder for the states of all the task instances.
ke_state_t sample128_state[SAMPLE128_IDX_MAX] __attribute__((section("retention_mem_area0"),zero_init));

#endif //BLE_SAMPLE128