105 lines
3.3 KiB
C
105 lines
3.3 KiB
C
/**
|
|
****************************************************************************************
|
|
* @addtogroup FINDTTASK
|
|
* @{
|
|
****************************************************************************************
|
|
*/
|
|
|
|
/*
|
|
* INCLUDE FILES
|
|
****************************************************************************************
|
|
*/
|
|
#include "rwip_config.h"
|
|
|
|
#if (BLE_FINDME_TARGET)
|
|
#include "attm.h"
|
|
#include "co_utils.h"
|
|
#include "findt.h"
|
|
#include "findt_task.h"
|
|
#include "gattc_task.h"
|
|
#include "prf_utils.h"
|
|
|
|
/*
|
|
* FUNCTION DEFINITIONS
|
|
****************************************************************************************
|
|
*/
|
|
|
|
/**
|
|
****************************************************************************************
|
|
* @brief Handles reception of the @ref GATTC_WRITE_REQ_IND message.
|
|
* The message is redirected from TASK_SVC because at profile enable, the ATT
|
|
*handle is register for TASK_FINDT. In the handler, an ATT Write Response/Error
|
|
*Response should be sent for ATT protocol, but Alert Level Characteristic only
|
|
*supports WNR so no response PDU is needed.
|
|
* @param[in] msgid Id of the message received (probably unused).
|
|
* @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 If the message was consumed or not.
|
|
****************************************************************************************
|
|
*/
|
|
__STATIC int gattc_write_req_ind_handler(
|
|
ke_msg_id_t const msgid, struct gattc_write_req_ind const *param,
|
|
ke_task_id_t const dest_id, ke_task_id_t const src_id) {
|
|
uint8_t alert_lvl = 0x0000;
|
|
uint8_t conidx = KE_IDX_GET(src_id);
|
|
// Allocate write confirmation message.
|
|
struct gattc_write_cfm *cfm =
|
|
KE_MSG_ALLOC(GATTC_WRITE_CFM, src_id, dest_id, gattc_write_cfm);
|
|
|
|
// Get the address of the environment
|
|
struct findt_env_tag *findt_env = PRF_ENV_GET(FINDT, findt);
|
|
uint8_t att_idx = FINDT_IDX(param->handle);
|
|
|
|
// Fill in the parameter structure
|
|
cfm->handle = param->handle;
|
|
cfm->status = PRF_APP_ERROR;
|
|
|
|
// Check if Alert Level is valid
|
|
if ((att_idx == FINDT_IAS_IDX_ALERT_LVL_VAL) &&
|
|
(param->value[0] <= FINDT_ALERT_HIGH)) {
|
|
alert_lvl = param->value[0];
|
|
cfm->status = GAP_ERR_NO_ERROR;
|
|
|
|
// Allocate the alert value change indication
|
|
struct findt_alert_ind *ind = KE_MSG_ALLOC(
|
|
FINDT_ALERT_IND, prf_dst_task_get(&(findt_env->prf_env), conidx),
|
|
dest_id, findt_alert_ind);
|
|
// Fill in the parameter structure
|
|
ind->alert_lvl = alert_lvl;
|
|
ind->conidx = conidx;
|
|
|
|
// Send the message
|
|
ke_msg_send(ind);
|
|
}
|
|
|
|
// Send the message
|
|
ke_msg_send(cfm);
|
|
|
|
return (KE_MSG_CONSUMED);
|
|
}
|
|
|
|
/*
|
|
* GLOBAL VARIABLE DEFINITIONS
|
|
****************************************************************************************
|
|
*/
|
|
|
|
/// Default State handlers definition
|
|
KE_MSG_HANDLER_TAB(findt){
|
|
{GATTC_WRITE_REQ_IND, (ke_msg_func_t)gattc_write_req_ind_handler},
|
|
};
|
|
|
|
void findt_task_init(struct ke_task_desc *task_desc) {
|
|
// Get the address of the environment
|
|
struct findt_env_tag *findt_env = PRF_ENV_GET(FINDT, findt);
|
|
|
|
task_desc->msg_handler_tab = findt_msg_handler_tab;
|
|
task_desc->msg_cnt = ARRAY_LEN(findt_msg_handler_tab);
|
|
task_desc->state = findt_env->state;
|
|
task_desc->idx_max = FINDT_IDX_MAX;
|
|
}
|
|
|
|
#endif // BLE_FINDME_TARGET
|
|
|
|
/// @} FINDTTASK
|