pinebuds/services/ble_app/app_hrps/app_hrps.c

157 lines
4.9 KiB
C

/***************************************************************************
*
* Copyright 2015-2019 BES.
* All rights reserved. All unpublished rights reserved.
*
* No part of this work may be used or reproduced in any form or by any
* means, or stored in a database or retrieval system, without prior written
* permission of BES.
*
* Use of this work is governed by a license granted by BES.
* This work contains confidential and proprietary information of
* BES. which is protected by copyright, trade secret,
* trademark and other intellectual property rights.
*
****************************************************************************/
#include "rwip_config.h" // SW configuration
#if (BLE_APP_HR)
#include "app_hrps.h"
#include "hrps.h"
#include "hrps_task.h"
#include "app.h" // Application Definitions
#include "app_task.h" // application task definitions
#include "co_bt.h"
#include "prf_types.h"
#include "prf_utils.h"
#include "arch.h" // Platform Definitions
#include "prf.h"
#include "string.h"
struct app_hrps_env_tag app_hrps_env;
void app_hrps_init(void)
{
// Reset the environment
memset(&app_hrps_env, 0x00, sizeof(app_hrps_env));
app_hrps_env.connectionIndex = INVALID_CONNECTION_INDEX;
app_hrps_env.isNotificationEnabled = false;
}
void app_hrps_connected_evt_handler(uint8_t conidx)
{
app_hrps_env.connectionIndex = conidx;
}
void app_hrps_disconnected_evt_handler(void)
{
app_hrps_env.connectionIndex = INVALID_CONNECTION_INDEX;
app_hrps_env.isNotificationEnabled = false;
}
void app_hrps_send_measument_via_notification(void)
{
if (app_hrps_env.isNotificationEnabled) {
struct hrps_meas_send_req *req = KE_MSG_ALLOC(HRPS_MEAS_SEND_REQ,
prf_get_task_from_id(TASK_ID_HRPS),
TASK_APP,
hrps_meas_send_req);
memcpy(req, &app_hrps_env.meas, sizeof(struct hrps_meas_send_req));
ke_msg_send(req);
}
}
void app_hrps_add_profile(void)
{
TRACE(0,"app_hrps_add_profile");
struct hrps_db_cfg* db_cfg;
struct gapm_profile_task_add_cmd *req = KE_MSG_ALLOC_DYN(GAPM_PROFILE_TASK_ADD_CMD,
TASK_GAPM, TASK_APP,
gapm_profile_task_add_cmd, sizeof(struct hrps_db_cfg));
// Fill message
req->operation = GAPM_PROFILE_TASK_ADD;
#if BLE_CONNECTION_MAX>1
req->sec_lvl = PERM(SVC_AUTH, ENABLE)|PERM(SVC_MI, ENABLE);
#else
req->sec_lvl = PERM(SVC_AUTH, ENABLE);
#endif
req->prf_task_id = TASK_ID_HRPS;
req->app_task = TASK_APP;
req->start_hdl = 0;
db_cfg = (struct hrps_db_cfg*) req->param;
db_cfg->features = HRPS_BODY_SENSOR_LOC_CHAR_SUP | HRPS_ENGY_EXP_FEAT_SUP | HRPS_HR_MEAS_NTF_CFG;
db_cfg->body_sensor_loc = 0;
// Send the message
ke_msg_send(req);
}
static int app_hrps_msg_handler(ke_msg_id_t const msgid,
void const *param,
ke_task_id_t const dest_id,
ke_task_id_t const src_id)
{
// Do nothing
return (KE_MSG_CONSUMED);
}
static int app_hrps_measurement_ccc_changed_handler(ke_msg_id_t const msgid,
struct hrps_cfg_indntf_ind *param,
ke_task_id_t const dest_id,
ke_task_id_t const src_id)
{
TRACE(2,"%s cfg: %d", __func__, param->cfg_val);
app_hrps_env.isNotificationEnabled = param->cfg_val;
return (KE_MSG_CONSUMED);
}
static int app_hrps_measurement_sent_handler(ke_msg_id_t const msgid,
void const *param,
ke_task_id_t const dest_id,
ke_task_id_t const src_id)
{
return (KE_MSG_CONSUMED);
}
static int app_hrps_ctrl_point_received_handler(ke_msg_id_t const msgid,
struct hrps_energy_exp_reset_ind *param,
ke_task_id_t const dest_id,
ke_task_id_t const src_id)
{
TRACE(1,"%s", __func__);
app_hrps_send_measument_via_notification();
return (KE_MSG_CONSUMED);
}
/// Default State handlers definition
const struct ke_msg_handler hrps_msg_handler_list[] =
{
// Note: first message is latest message checked by kernel so default is put on top.
{KE_MSG_DEFAULT_HANDLER, (ke_msg_func_t)app_hrps_msg_handler},
{HRPS_CFG_INDNTF_IND, (ke_msg_func_t)app_hrps_measurement_ccc_changed_handler},
{HRP_MEASUREMENT_DATA_SENT, (ke_msg_func_t)app_hrps_measurement_sent_handler},
{HRPS_ENERGY_EXP_RESET_IND, (ke_msg_func_t)app_hrps_ctrl_point_received_handler},
};
const struct ke_state_handler app_hrps_table_handler =
{&hrps_msg_handler_list[0], (sizeof(hrps_msg_handler_list)/sizeof(struct ke_msg_handler))};
#endif