pinebuds/services/ble_app/app_hrps/app_hrps.c
Ben V. Brown 75381150fd Formatting
Formatting Pass 1

Lots of fixups to adding stdint and stdbool all over the place

Formatting Pass 2
Formatting Pass 3
Formatting Pass 4

Update app_bt_stream.cpp
2023-02-02 07:56:49 +11:00

146 lines
4.5 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 "arch.h" // Platform Definitions
#include "co_bt.h"
#include "prf.h"
#include "prf_types.h"
#include "prf_utils.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