New Service Addition

Hi VesaN,

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

/**
****************************************************************************************
*
* @file sample128_task.c
*
*@brief Sample128任务实现。
*
*@UUID服务。样本代码
*
*版权所有（C）2013 Dialog S雷竞技电竞平台emiconductor GmbH及其附属公司，未出版作品
* This computer program includes Confidential, Proprietary Information and is a Trade Secret
*Dial雷竞技电竞平台og Semiconductor GmbH及其附属公司。所有使用、披露和/或
*未经书面授权，禁止复制。版权所有。
*
****************************************************************************************
*/

/*
*包含文件
****************************************************************************************
*/

#include "rwble_config.h"

#if (BLE_SAMPLE128)

#include "gap.h"
#包括“gapc.h”
#包括“gattc\u task.h”
#include“Atts_util.h”
#include "sample128.h"
#include“sample128_task.h”
#include "attm_cfg.h"
#包括“attm\u db.h”
#include“prf_utils.h”

/*
*功能定义
****************************************************************************************
*/

/**
****************************************************************************************
* @brief处理@ref sample128_create_db_req消息的接收。
*@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,
Keu任务\u id \u t const src \u id）
{
//数据库创建状态
uint8_t status;

uint8_t nb_att_16;
uint8\ t nb\ U att\ U 128；
uint8_t nb_att_32;
uint16_t att_decl_svc = ATT_DECL_PRIMARY_SERVICE;
UINT16_T ATT_DECL_CHAR = ATT_DECL_CHAROMATION;
UINT16_T ATT_DECL_CFG = ATT_DESC_CLIENT_CHAR_CHAR_CFG;
uint16值hdl；
uint16_t char_hdl;

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

/*---------------------------------------------------*
* Sample128服务创建
*---------------------------------------------------*/

//将服务添加到数据库中

nb_att_16 = 5; // 6...4 UUID16 Attribute declaration types
nb_att_32 = 0; // 0 UUID32 Attribute declaration types
注意：附件128=3；//2个UUID128属性声明类型

状态=attmdb\u add\u服务（&（sample128\u env.sample128\u shdl），
任务样本128，
nb_att_16,
注意，附件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\u t*）&att\u decl\u svc，//0x2800表示主服务声明
perm（rd，启用），//权限
&（sample128\u env.sample128\u 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: ////////////////////////////////////////////////////////////////////////////////

//将特征声明属性添加到数据库
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，启用），//权限
＆（char_hdl）//处理特征声明
);

// Add characteristic value declaration attribute to database
status = attmdb_add_attribute（sample128_env.sample128_shdl，
sizeof（uint8\u t），//数据大小=1字节
ATT_UUID_128_LEN,// Size of custom declaration type = 128bit
（uint8_t *）＆sample128_1_val.uuid，// uuid的特征值
PERM（RD，ENABLE）| PERM（WR，ENABLE），//权限
&(val_hdl) // handle to the value attribute
);

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

//设置特征的初始值1
status = attmdb_att_set_value(char_hdl, sizeof(sample128_1_char), (uint8_t *)&sample128_1_char);

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

//将特征声明属性添加到数据库
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，//声明类型ID的大小
(uint8_t*) &att_decl_char, // 0x2803 for a characteristic declaration
perm（rd，启用），//权限
＆（char_hdl）//处理特征声明
);

// 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的特征值
PERM(RD, ENABLE) | PERM(NTF, ENABLE),// Permissions
&(val_hdl) // Handle to the value attribute
);

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

//设置特征2的初始值
status=attmdb\u att\u set\u value（char\u hdl，sizeof（sample128\u 2\u char），（uint8\u t*）&sample128\u 2\u 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\u t*）&att\u decl\u cfg，//0x2902客户端配置声明类型的UUID
PERM(RD, ENABLE) | PERM(WR, ENABLE), // Permissions
&(val_hdl) // Handle to value attribute
);

//写的特征3：////////////////////////////////////////////////////////////////////////////////

//将特征声明属性添加到数据库
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，启用），//权限
＆（char_hdl）//处理特征声明
);

// Add characteristic value declaration attribute to database
status = attmdb_add_attribute（sample128_env.sample128_shdl，
sizeof（my\u\t），//数据大小=1字节
ATT_UUID_128_LEN,// Size of custom declaration type = 128bit
（uint8_t *）＆sample128_3_val.uuid，// uuid的特征值
PERM（RD，ENABLE）| PERM（WR，ENABLE），//权限
&(val_hdl) // handle to the value attribute
);

//存储特征3的值句柄
memcpy（sample128_3_char.attr_hdl，＆val_hdl，sizeof（uint16_t））;

//设置特征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));

//如果我们在这里，数据库已经成功完成，转到空闲状态
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,
任务（SAMPLE128，SAMPLE128，create，db，cfm）；
cfm->status=状态；
ke_msg_send(cfm);

return (KE_MSG_CONSUMED);
}

/**
****************************************************************************************
*@brief启用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消息是否被消耗。
****************************************************************************************
*/
静态int sample128 \u enable \u req \u handler（ke \u msg \u id \u t const msgid，
struct sample128_enable_req const *param,
ke_task_id_t const dest_id,
Keu任务\u id \u t const src \u id）
{

uint16_t temp = 1;

// Keep source of message, to respond to it further on
sample128\u env.con\u info.appid=src\u id；
//存储启用此配置文件的连接句柄
sample128_env.con_info.conidx = gapc_get_conidx(param->conhdl);

//检查提供的连接是否存在
if（sample128\u env.con\u info.conidx==GAP\u INVALID\u conidx）
{
// The connection doesn't exist, request disallowed
prf_server_error_ind_send((prf_env_struct *)&sample128_env, PRF_ERR_REQ_DISALLOWED,
SAMPLE128\u ERROR\u IND，SAMPLE128\u ENABLE\u REQ）；
}
else
{
//Sample128服务权限
attmdb_svc_set_permission（sample128_env.sample128_shdl，param-> sec_l​​vl）;

// 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);

// Set characteristic 2 to specified value
attmdb\ att\ set\值（sample128\ env.sample128\ shdl+sample128\ 2\ IDX\ VAL，
sizeof（uint8_t），（uint8_t *）和param-> sample128_2_val）;

//将特征3设置为规定值
attmdb_att_set_value(sample128_env.sample128_shdl + SAMPLE128_3_IDX_VAL,
sizeof（uint8_t），（uint8_t *）和param-> sample128_3_val）;

sample128_env.feature = param->特征;

如果（！样本128（环境特征）
{
temp = 0;
}

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

// Go to Connected state
keu state集（TASK\u SAMPLE128，SAMPLE128\u 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,
Keu任务\u id \u t const src \u 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\值（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\u env.sample128\u shdl+sample128\u 2\u IDX\u 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\u WRITE\u CMD\u 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消息是否被消耗。
****************************************************************************************
*/
msgid静态int gattc_write_cmd_ind_handler（ke_msg_id_t const，
结构gattc\u write\u cmd\u ind const*param，
ke_task_id_t const dest_id,
Keu任务\u id \u t const src \u id）
{
uint8\u t char\u code=SAMPLE128\u ERR\u char；
uint8\u t status=PRF\u APP\u错误；

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\u code==SAMPLE128\u 1\u char）
{

//保存值（DB）
attmdb_att_set_value（param->句柄，sizeof（uint8_t），（uint8_t *）和param->值[0]）;

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

status = PRF_ERR_OK;

}
否则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_NTFIND）| |（ntf_cfg==PRF_CLI_ntf START））
{
//保存值（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设置为1
sample128|env.feature |=PRF|u CLI|u START|NTF；
}
else
{
// ntf cfg bit设置为0
sample128_env.feature＆=〜prf_cli_start_ntf;
}

status = PRF_ERR_OK;

}
}

else if（char\u code==SAMPLE128\u 3\u char）
{

//保存值（DB）
attmdb_att_set_value（param->句柄，sizeof（uint8_t），（uint8_t *）和param->值[0]）;

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

status = PRF_ERR_OK;

}
}

//发送写响应
atts_write_rsp_send（sample128_env.con_info.conidx，param->handle，status）；

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,
结构gapc\u disconnect\u ind const*参数，
ke_task_id_t const dest_id,
Keu任务\u id \u t const src \u id）
{

// Check Connection Handle
if（ke_idx_get（src_id）== sample128_env.con_info.conidx）
{

//在任何情况下，通知应用程序关于断开连接
sample128_disable（）;
}

return (KE_MSG_CONSUMED);
}

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

///禁用状态处理程序定义。
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 },
};

///空闲状态处理程序定义。
const struct ke_msg_handler sample128_idle[] =
{
{SAMPLE128_ENABLE_REQ, (ke_msg_func_t) sample128_enable_req_handler },

};

///连接状态处理程序定义。
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，（ke_msg_func_t）gattc_write_cmd_ind_handler3},

};

/// Default State handlers definition
const struct ke \u msg \u handler sample128 \u default \u state[]=
{
{GAPC_DISCONNECT_IND, (ke_msg_func_t) gap_disconnnect_ind_handler},
};

///指定每个输入状态的消息处理程序结构。
const struct ke\u state\u handler sample128\u state\u handler[sample128\u state\u MAX]=
{
[SAMPLE128\u DISABLED]=KE\u STATE\u HANDLER（SAMPLE128\u DISABLED），
[SAMPLE128_IDLE] = KE_STATE_HANDLER(sample128_idle),
[SAMPLE128_CONNECTED] = KE_STATE_HANDLER(sample128_connected),
};

///指定所有状态常见的消息处理程序。
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 __（（部分（“保留_mem_area0”），zero_init））;

#endif //BLE_SAMPLE128