BLE_Nano nRF51 Central heart rate
Diff: main.c
- Revision:
- 0:2b9b5764efb5
diff -r 000000000000 -r 2b9b5764efb5 main.c --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.c Thu May 26 10:12:27 2016 +0000 @@ -0,0 +1,882 @@ +/* + * Copyright (c) 2014 Nordic Semiconductor. All Rights Reserved. + * + * The information contained herein is confidential property of Nordic Semiconductor. The use, + * copying, transfer or disclosure of such information is prohibited except by express written + * agreement with Nordic Semiconductor. + * + */ + +/** + * @brief BLE Heart Rate Collector application main file. + * + * This file contains the source code for a sample heart rate collector. + */ + +#include <stdint.h> +#include <stdio.h> +#include <string.h> +#include "nordic_common.h" +#include "nrf_sdm.h" +#include "ble.h" +#include "ble_hci.h" +#include "ble_db_discovery.h" +#include "softdevice_handler.h" +#include "app_util.h" +#include "app_error.h" +#include "boards.h" +#include "nrf_gpio.h" +#include "pstorage.h" +#include "device_manager.h" +#include "ble_hrs_c.h" +#include "ble_bas_c.h" +#include "app_util.h" +#include "app_timer.h" +#include "bsp.h" +#include "bsp_btn_ble.h" +#include "nrf_log.h" + +#define CENTRAL_LINK_COUNT 1 /**< Number of central links used by the application. When changing this number remember to adjust the RAM settings*/ +#define PERIPHERAL_LINK_COUNT 0 /**< Number of peripheral links used by the application. When changing this number remember to adjust the RAM settings*/ + +#define STRING_BUFFER_LEN 50 +#define BOND_DELETE_ALL_BUTTON_ID 0 /**< Button used for deleting all bonded centrals during startup. */ + +#define APP_TIMER_PRESCALER 0 /**< Value of the RTC1 PRESCALER register. */ +#define APP_TIMER_OP_QUEUE_SIZE 2 /**< Size of timer operation queues. */ + +#define APPL_LOG NRF_LOG_PRINTF /**< Logger macro that will be used in this file to do logging over UART or RTT based on nrf_log configuration. */ +#define APPL_LOG_DEBUG NRF_LOG_PRINTF_DEBUG /**< Debug logger macro that will be used in this file to do logging of debug information over UART or RTT based on nrf_log configuration. This will only work if DEBUG is defined*/ + +#define SEC_PARAM_BOND 1 /**< Perform bonding. */ +#define SEC_PARAM_MITM 1 /**< Man In The Middle protection not required. */ +#define SEC_PARAM_LESC 0 /**< LE Secure Connections not enabled. */ +#define SEC_PARAM_KEYPRESS 0 /**< Keypress notifications not enabled. */ +#define SEC_PARAM_IO_CAPABILITIES BLE_GAP_IO_CAPS_NONE /**< No I/O capabilities. */ +#define SEC_PARAM_OOB 0 /**< Out Of Band data not available. */ +#define SEC_PARAM_MIN_KEY_SIZE 7 /**< Minimum encryption key size. */ +#define SEC_PARAM_MAX_KEY_SIZE 16 /**< Maximum encryption key size. */ + +#define SCAN_INTERVAL 0x00A0 /**< Determines scan interval in units of 0.625 millisecond. */ +#define SCAN_WINDOW 0x0050 /**< Determines scan window in units of 0.625 millisecond. */ + +#define MIN_CONNECTION_INTERVAL MSEC_TO_UNITS(7.5, UNIT_1_25_MS) /**< Determines minimum connection interval in millisecond. */ +#define MAX_CONNECTION_INTERVAL MSEC_TO_UNITS(30, UNIT_1_25_MS) /**< Determines maximum connection interval in millisecond. */ +#define SLAVE_LATENCY 0 /**< Determines slave latency in counts of connection events. */ +#define SUPERVISION_TIMEOUT MSEC_TO_UNITS(4000, UNIT_10_MS) /**< Determines supervision time-out in units of 10 millisecond. */ + +#define TARGET_UUID 0x180D /**< Target device name that application is looking for. */ +#define UUID16_SIZE 2 /**< Size of 16 bit UUID */ + +/**@breif Macro to unpack 16bit unsigned UUID from octet stream. */ +#define UUID16_EXTRACT(DST, SRC) \ + do \ + { \ + (*(DST)) = (SRC)[1]; \ + (*(DST)) <<= 8; \ + (*(DST)) |= (SRC)[0]; \ + } while (0) + +/**@brief Variable length data encapsulation in terms of length and pointer to data */ +typedef struct +{ + uint8_t * p_data; /**< Pointer to data. */ + uint16_t data_len; /**< Length of data. */ +}data_t; + +typedef enum +{ + BLE_NO_SCAN, /**< No advertising running. */ + BLE_WHITELIST_SCAN, /**< Advertising with whitelist. */ + BLE_FAST_SCAN, /**< Fast advertising running. */ +} ble_scan_mode_t; + +static ble_db_discovery_t m_ble_db_discovery; /**< Structure used to identify the DB Discovery module. */ +static ble_hrs_c_t m_ble_hrs_c; /**< Structure used to identify the heart rate client module. */ +static ble_bas_c_t m_ble_bas_c; /**< Structure used to identify the Battery Service client module. */ +static ble_gap_scan_params_t m_scan_param; /**< Scan parameters requested for scanning and connection. */ +static dm_application_instance_t m_dm_app_id; /**< Application identifier. */ +static dm_handle_t m_dm_device_handle; /**< Device Identifier identifier. */ +static uint8_t m_peer_count = 0; /**< Number of peer's connected. */ +static ble_scan_mode_t m_scan_mode = BLE_FAST_SCAN; /**< Scan mode used by application. */ +static uint16_t m_conn_handle; /**< Current connection handle. */ +static volatile bool m_whitelist_temporarily_disabled = false; /**< True if whitelist has been temporarily disabled. */ + +static bool m_memory_access_in_progress = false; /**< Flag to keep track of ongoing operations on persistent memory. */ + +/** + * @brief Connection parameters requested for connection. + */ +static const ble_gap_conn_params_t m_connection_param = +{ + (uint16_t)MIN_CONNECTION_INTERVAL, // Minimum connection + (uint16_t)MAX_CONNECTION_INTERVAL, // Maximum connection + 0, // Slave latency + (uint16_t)SUPERVISION_TIMEOUT // Supervision time-out +}; + +static void scan_start(void); + + +/**@brief Function for asserts in the SoftDevice. + * + * @details This function will be called in case of an assert in the SoftDevice. + * + * @warning This handler is an example only and does not fit a final product. You need to analyze + * how your product is supposed to react in case of Assert. + * @warning On assert from the SoftDevice, the system can only recover on reset. + * + * @param[in] line_num Line number of the failing ASSERT call. + * @param[in] p_file_name File name of the failing ASSERT call. + */ +void assert_nrf_callback(uint16_t line_num, const uint8_t * p_file_name) +{ + app_error_handler(0xDEADBEEF, line_num, p_file_name); +} + +void uart_error_handle(app_uart_evt_t * p_event) +{ + if (p_event->evt_type == APP_UART_COMMUNICATION_ERROR) + { + APP_ERROR_HANDLER(p_event->data.error_communication); + } + else if (p_event->evt_type == APP_UART_FIFO_ERROR) + { + APP_ERROR_HANDLER(p_event->data.error_code); + } +} + + +/**@brief Function for handling database discovery events. + * + * @details This function is callback function to handle events from the database discovery module. + * Depending on the UUIDs that are discovered, this function should forward the events + * to their respective services. + * + * @param[in] p_event Pointer to the database discovery event. + */ +static void db_disc_handler(ble_db_discovery_evt_t * p_evt) +{ + ble_hrs_on_db_disc_evt(&m_ble_hrs_c, p_evt); + ble_bas_on_db_disc_evt(&m_ble_bas_c, p_evt); +} + + +/**@brief Callback handling device manager events. + * + * @details This function is called to notify the application of device manager events. + * + * @param[in] p_handle Device Manager Handle. For link related events, this parameter + * identifies the peer. + * @param[in] p_event Pointer to the device manager event. + * @param[in] event_status Status of the event. + */ +static ret_code_t device_manager_event_handler(const dm_handle_t * p_handle, + const dm_event_t * p_event, + const ret_code_t event_result) +{ + uint32_t err_code; + + switch (p_event->event_id) + { + case DM_EVT_CONNECTION: + { + APPL_LOG_DEBUG("[APPL]: >> DM_EVT_CONNECTION\r\n"); +#ifdef ENABLE_DEBUG_LOG_SUPPORT + ble_gap_addr_t * peer_addr; + peer_addr = &p_event->event_param.p_gap_param->params.connected.peer_addr; + APPL_LOG_DEBUG("[APPL]:[%02X %02X %02X %02X %02X %02X]: Connection Established\r\n", + peer_addr->addr[0], peer_addr->addr[1], peer_addr->addr[2], + peer_addr->addr[3], peer_addr->addr[4], peer_addr->addr[5]); +#endif // ENABLE_DEBUG_LOG_SUPPORT + + err_code = bsp_indication_set(BSP_INDICATE_CONNECTED); + APP_ERROR_CHECK(err_code); + + m_conn_handle = p_event->event_param.p_gap_param->conn_handle; + + m_dm_device_handle = (*p_handle); + + // Initiate bonding. + err_code = dm_security_setup_req(&m_dm_device_handle); + APP_ERROR_CHECK(err_code); + + m_peer_count++; + + if (m_peer_count < CENTRAL_LINK_COUNT) + { + scan_start(); + } + APPL_LOG_DEBUG("[APPL]: << DM_EVT_CONNECTION\r\n"); + break; + } + + case DM_EVT_DISCONNECTION: + { + APPL_LOG_DEBUG("[APPL]: >> DM_EVT_DISCONNECTION\r\n"); + memset(&m_ble_db_discovery, 0 , sizeof (m_ble_db_discovery)); + + err_code = bsp_indication_set(BSP_INDICATE_IDLE); + APP_ERROR_CHECK(err_code); + + if (m_peer_count == CENTRAL_LINK_COUNT) + { + scan_start(); + } + m_peer_count--; + APPL_LOG_DEBUG("[APPL]: << DM_EVT_DISCONNECTION\r\n"); + break; + } + + case DM_EVT_SECURITY_SETUP: + { + APPL_LOG_DEBUG("[APPL]:[0x%02X] >> DM_EVT_SECURITY_SETUP\r\n", p_handle->connection_id); + // Slave securtiy request received from peer, if from a non bonded device, + // initiate security setup, else, wait for encryption to complete. + err_code = dm_security_setup_req(&m_dm_device_handle); + APP_ERROR_CHECK(err_code); + APPL_LOG_DEBUG("[APPL]:[0x%02X] << DM_EVT_SECURITY_SETUP\r\n", p_handle->connection_id); + break; + } + + case DM_EVT_SECURITY_SETUP_COMPLETE: + { + APPL_LOG_DEBUG("[APPL]: >> DM_EVT_SECURITY_SETUP_COMPLETE\r\n"); + APPL_LOG_DEBUG("[APPL]: << DM_EVT_SECURITY_SETUP_COMPLETE\r\n"); + break; + } + + case DM_EVT_LINK_SECURED: + APPL_LOG_DEBUG("[APPL]: >> DM_LINK_SECURED_IND\r\n"); + // Discover peer's services. + err_code = ble_db_discovery_start(&m_ble_db_discovery, + p_event->event_param.p_gap_param->conn_handle); + APP_ERROR_CHECK(err_code); + APPL_LOG_DEBUG("[APPL]: << DM_LINK_SECURED_IND\r\n"); + break; + + case DM_EVT_DEVICE_CONTEXT_LOADED: + APPL_LOG_DEBUG("[APPL]: >> DM_EVT_LINK_SECURED\r\n"); + APP_ERROR_CHECK(event_result); + APPL_LOG_DEBUG("[APPL]: << DM_EVT_DEVICE_CONTEXT_LOADED\r\n"); + break; + + case DM_EVT_DEVICE_CONTEXT_STORED: + APPL_LOG_DEBUG("[APPL]: >> DM_EVT_DEVICE_CONTEXT_STORED\r\n"); + APP_ERROR_CHECK(event_result); + APPL_LOG_DEBUG("[APPL]: << DM_EVT_DEVICE_CONTEXT_STORED\r\n"); + break; + + case DM_EVT_DEVICE_CONTEXT_DELETED: + APPL_LOG_DEBUG("[APPL]: >> DM_EVT_DEVICE_CONTEXT_DELETED\r\n"); + APP_ERROR_CHECK(event_result); + APPL_LOG_DEBUG("[APPL]: << DM_EVT_DEVICE_CONTEXT_DELETED\r\n"); + break; + + default: + break; + } + + return NRF_SUCCESS; +} + + +/** + * @brief Parses advertisement data, providing length and location of the field in case + * matching data is found. + * + * @param[in] Type of data to be looked for in advertisement data. + * @param[in] Advertisement report length and pointer to report. + * @param[out] If data type requested is found in the data report, type data length and + * pointer to data will be populated here. + * + * @retval NRF_SUCCESS if the data type is found in the report. + * @retval NRF_ERROR_NOT_FOUND if the data type could not be found. + */ +static uint32_t adv_report_parse(uint8_t type, data_t * p_advdata, data_t * p_typedata) +{ + uint32_t index = 0; + uint8_t * p_data; + + p_data = p_advdata->p_data; + + while (index < p_advdata->data_len) + { + uint8_t field_length = p_data[index]; + uint8_t field_type = p_data[index+1]; + + if (field_type == type) + { + p_typedata->p_data = &p_data[index+2]; + p_typedata->data_len = field_length-1; + return NRF_SUCCESS; + } + index += field_length + 1; + } + return NRF_ERROR_NOT_FOUND; +} + + +/**@brief Function for putting the chip into sleep mode. + * + * @note This function will not return. + */ +static void sleep_mode_enter(void) +{ + uint32_t err_code = bsp_indication_set(BSP_INDICATE_IDLE); + APP_ERROR_CHECK(err_code); + + // Prepare wakeup buttons. + err_code = bsp_btn_ble_sleep_mode_prepare(); + APP_ERROR_CHECK(err_code); + + // Go to system-off mode (this function will not return; wakeup will cause a reset). + err_code = sd_power_system_off(); + APP_ERROR_CHECK(err_code); +} + + +/**@brief Function for handling the Application's BLE Stack events. + * + * @param[in] p_ble_evt Bluetooth stack event. + */ +static void on_ble_evt(ble_evt_t * p_ble_evt) +{ + uint32_t err_code; + const ble_gap_evt_t * p_gap_evt = &p_ble_evt->evt.gap_evt; + + switch (p_ble_evt->header.evt_id) + { + case BLE_GAP_EVT_ADV_REPORT: + { + data_t adv_data; + data_t type_data; + + // Initialize advertisement report for parsing. + adv_data.p_data = (uint8_t *)p_gap_evt->params.adv_report.data; + adv_data.data_len = p_gap_evt->params.adv_report.dlen; + + err_code = adv_report_parse(BLE_GAP_AD_TYPE_16BIT_SERVICE_UUID_MORE_AVAILABLE, + &adv_data, + &type_data); + + if (err_code != NRF_SUCCESS) + { + // Compare short local name in case complete name does not match. + err_code = adv_report_parse(BLE_GAP_AD_TYPE_16BIT_SERVICE_UUID_COMPLETE, + &adv_data, + &type_data); + } + + // Verify if short or complete name matches target. + if (err_code == NRF_SUCCESS) + { + uint16_t extracted_uuid; + + // UUIDs found, look for matching UUID + for (uint32_t u_index = 0; u_index < (type_data.data_len/UUID16_SIZE); u_index++) + { + UUID16_EXTRACT(&extracted_uuid,&type_data.p_data[u_index * UUID16_SIZE]); + + APPL_LOG_DEBUG("\t[APPL]: %x\r\n",extracted_uuid); + + if(extracted_uuid == TARGET_UUID) + { + // Stop scanning. + err_code = sd_ble_gap_scan_stop(); + + if (err_code != NRF_SUCCESS) + { + APPL_LOG_DEBUG("[APPL]: Scan stop failed, reason %d\r\n", err_code); + } + err_code = bsp_indication_set(BSP_INDICATE_IDLE); + APP_ERROR_CHECK(err_code); + + m_scan_param.selective = 0; + m_scan_param.p_whitelist = NULL; + + // Initiate connection. + err_code = sd_ble_gap_connect(&p_gap_evt->params.adv_report.peer_addr, + &m_scan_param, + &m_connection_param); + + m_whitelist_temporarily_disabled = false; + + if (err_code != NRF_SUCCESS) + { + APPL_LOG_DEBUG("[APPL]: Connection Request Failed, reason %d\r\n", err_code); + } + break; + } + } + } + break; + } + + case BLE_GAP_EVT_TIMEOUT: + if (p_gap_evt->params.timeout.src == BLE_GAP_TIMEOUT_SRC_SCAN) + { + APPL_LOG_DEBUG("[APPL]: Scan timed out.\r\n"); + scan_start(); + } + else if (p_gap_evt->params.timeout.src == BLE_GAP_TIMEOUT_SRC_CONN) + { + APPL_LOG_DEBUG("[APPL]: Connection Request timed out.\r\n"); + } + break; + case BLE_GAP_EVT_CONNECTED: + { + err_code = ble_hrs_c_handles_assign(&m_ble_hrs_c, p_gap_evt->conn_handle, NULL); + APP_ERROR_CHECK(err_code); + err_code = ble_bas_c_handles_assign(&m_ble_bas_c, p_gap_evt->conn_handle, NULL); + APP_ERROR_CHECK(err_code); + break; + } + case BLE_GAP_EVT_CONN_PARAM_UPDATE_REQUEST: + // Accepting parameters requested by peer. + err_code = sd_ble_gap_conn_param_update(p_gap_evt->conn_handle, + &p_gap_evt->params.conn_param_update_request.conn_params); + APP_ERROR_CHECK(err_code); + break; + + default: + break; + } +} + + +/**@brief Function for handling the Application's system events. + * + * @param[in] sys_evt system event. + */ +static void on_sys_evt(uint32_t sys_evt) +{ + switch (sys_evt) + { + case NRF_EVT_FLASH_OPERATION_SUCCESS: + /* fall through */ + case NRF_EVT_FLASH_OPERATION_ERROR: + + if (m_memory_access_in_progress) + { + m_memory_access_in_progress = false; + scan_start(); + } + break; + + default: + // No implementation needed. + break; + } +} + + +/**@brief Function for dispatching a BLE stack event to all modules with a BLE stack event handler. + * + * @details This function is called from the scheduler in the main loop after a BLE stack event has + * been received. + * + * @param[in] p_ble_evt Bluetooth stack event. + */ +static void ble_evt_dispatch(ble_evt_t * p_ble_evt) +{ + dm_ble_evt_handler(p_ble_evt); + ble_db_discovery_on_ble_evt(&m_ble_db_discovery, p_ble_evt); + ble_hrs_c_on_ble_evt(&m_ble_hrs_c, p_ble_evt); + ble_bas_c_on_ble_evt(&m_ble_bas_c, p_ble_evt); + bsp_btn_ble_on_ble_evt(p_ble_evt); + on_ble_evt(p_ble_evt); +} + + +/**@brief Function for dispatching a system event to interested modules. + * + * @details This function is called from the System event interrupt handler after a system + * event has been received. + * + * @param[in] sys_evt System stack event. + */ +static void sys_evt_dispatch(uint32_t sys_evt) +{ + pstorage_sys_event_handler(sys_evt); + on_sys_evt(sys_evt); +} + + +/**@brief Function for initializing the BLE stack. + * + * @details Initializes the SoftDevice and the BLE event interrupt. + */ +static void ble_stack_init(void) +{ + uint32_t err_code; + + nrf_clock_lf_cfg_t clock_lf_cfg = NRF_CLOCK_LFCLKSRC; + + // Initialize the SoftDevice handler module. + SOFTDEVICE_HANDLER_INIT(&clock_lf_cfg, NULL); + + ble_enable_params_t ble_enable_params; + err_code = softdevice_enable_get_default_config(CENTRAL_LINK_COUNT, + PERIPHERAL_LINK_COUNT, + &ble_enable_params); + APP_ERROR_CHECK(err_code); + + //Check the ram settings against the used number of links + CHECK_RAM_START_ADDR(CENTRAL_LINK_COUNT,PERIPHERAL_LINK_COUNT); + + // Enable BLE stack. + err_code = softdevice_enable(&ble_enable_params); + APP_ERROR_CHECK(err_code); + + // Register with the SoftDevice handler module for BLE events. + err_code = softdevice_ble_evt_handler_set(ble_evt_dispatch); + APP_ERROR_CHECK(err_code); + + // Register with the SoftDevice handler module for System events. + err_code = softdevice_sys_evt_handler_set(sys_evt_dispatch); + APP_ERROR_CHECK(err_code); +} + + +/**@brief Function for the Device Manager initialization. + * + * @param[in] erase_bonds Indicates whether bonding information should be cleared from + * persistent storage during initialization of the Device Manager. + */ +static void device_manager_init(bool erase_bonds) +{ + uint32_t err_code; + dm_init_param_t init_param = {.clear_persistent_data = erase_bonds}; + dm_application_param_t register_param; + + err_code = pstorage_init(); + APP_ERROR_CHECK(err_code); + + err_code = dm_init(&init_param); + APP_ERROR_CHECK(err_code); + + memset(®ister_param.sec_param, 0, sizeof (ble_gap_sec_params_t)); + + // Event handler to be registered with the module. + register_param.evt_handler = device_manager_event_handler; + + // Service or protocol context for device manager to load, store and apply on behalf of application. + // Here set to client as application is a GATT client. + register_param.service_type = DM_PROTOCOL_CNTXT_GATT_CLI_ID; + + // Secuirty parameters to be used for security procedures. + register_param.sec_param.bond = SEC_PARAM_BOND; + register_param.sec_param.mitm = SEC_PARAM_MITM; + register_param.sec_param.lesc = SEC_PARAM_LESC; + register_param.sec_param.keypress = SEC_PARAM_KEYPRESS; + register_param.sec_param.io_caps = SEC_PARAM_IO_CAPABILITIES; + register_param.sec_param.oob = SEC_PARAM_OOB; + register_param.sec_param.min_key_size = SEC_PARAM_MIN_KEY_SIZE; + register_param.sec_param.max_key_size = SEC_PARAM_MAX_KEY_SIZE; + register_param.sec_param.kdist_peer.enc = 1; + register_param.sec_param.kdist_peer.id = 1; + + err_code = dm_register(&m_dm_app_id, ®ister_param); + APP_ERROR_CHECK(err_code); +} + + +/**@brief Function for disabling the use of whitelist for scanning. + */ +static void whitelist_disable(void) +{ + uint32_t err_code; + + if ((m_scan_mode == BLE_WHITELIST_SCAN) && !m_whitelist_temporarily_disabled) + { + m_whitelist_temporarily_disabled = true; + + err_code = sd_ble_gap_scan_stop(); + if (err_code == NRF_SUCCESS) + { + scan_start(); + } + else if (err_code != NRF_ERROR_INVALID_STATE) + { + APP_ERROR_CHECK(err_code); + } + } + m_whitelist_temporarily_disabled = true; +} + + +/**@brief Function for handling events from the BSP module. + * + * @param[in] event Event generated by button press. + */ +void bsp_event_handler(bsp_event_t event) +{ + uint32_t err_code; + switch (event) + { + case BSP_EVENT_SLEEP: + sleep_mode_enter(); + break; + + case BSP_EVENT_DISCONNECT: + err_code = sd_ble_gap_disconnect(m_conn_handle, BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION); + if (err_code != NRF_ERROR_INVALID_STATE) + { + APP_ERROR_CHECK(err_code); + } + break; + + case BSP_EVENT_WHITELIST_OFF: + whitelist_disable(); + break; + + default: + break; + } +} + + +/**@brief Heart Rate Collector Handler. + */ +static void hrs_c_evt_handler(ble_hrs_c_t * p_hrs_c, ble_hrs_c_evt_t * p_hrs_c_evt) +{ + uint32_t err_code; + + switch (p_hrs_c_evt->evt_type) + { + case BLE_HRS_C_EVT_DISCOVERY_COMPLETE: + + // Heart rate service discovered. Enable notification of Heart Rate Measurement. + err_code = ble_hrs_c_hrm_notif_enable(p_hrs_c); + APP_ERROR_CHECK(err_code); + + APPL_LOG_DEBUG("Heart rate service discovered \r\n"); + break; + + case BLE_HRS_C_EVT_HRM_NOTIFICATION: + { + APPL_LOG_DEBUG("[APPL]: HR Measurement received %d \r\n", p_hrs_c_evt->params.hrm.hr_value); + + APPL_LOG("Heart Rate = %d\r\n", p_hrs_c_evt->params.hrm.hr_value); + break; + } + + default: + break; + } +} + + +/**@brief Battery levelCollector Handler. + */ +static void bas_c_evt_handler(ble_bas_c_t * p_bas_c, ble_bas_c_evt_t * p_bas_c_evt) +{ + uint32_t err_code; + + switch (p_bas_c_evt->evt_type) + { + case BLE_BAS_C_EVT_DISCOVERY_COMPLETE: + // Batttery service discovered. Enable notification of Battery Level. + APPL_LOG_DEBUG("[APPL]: Battery Service discovered. \r\n"); + + APPL_LOG_DEBUG("[APPL]: Reading battery level. \r\n"); + + err_code = ble_bas_c_bl_read(p_bas_c); + APP_ERROR_CHECK(err_code); + + + APPL_LOG_DEBUG("[APPL]: Enabling Battery Level Notification. \r\n"); + err_code = ble_bas_c_bl_notif_enable(p_bas_c); + APP_ERROR_CHECK(err_code); + + break; + + case BLE_BAS_C_EVT_BATT_NOTIFICATION: + { + APPL_LOG_DEBUG("[APPL]: Battery Level received %d %%\r\n", p_bas_c_evt->params.battery_level); + + APPL_LOG_DEBUG("Battery = %d %%\r\n", p_bas_c_evt->params.battery_level); + break; + } + + case BLE_BAS_C_EVT_BATT_READ_RESP: + { + APPL_LOG_DEBUG("[APPL]: Battery Level Read as %d %%\r\n", p_bas_c_evt->params.battery_level); + + APPL_LOG_DEBUG("Battery = %d %%\r\n", p_bas_c_evt->params.battery_level); + break; + } + + default: + break; + } +} + + +/** + * @brief Heart rate collector initialization. + */ +static void hrs_c_init(void) +{ + ble_hrs_c_init_t hrs_c_init_obj; + + hrs_c_init_obj.evt_handler = hrs_c_evt_handler; + + uint32_t err_code = ble_hrs_c_init(&m_ble_hrs_c, &hrs_c_init_obj); + APP_ERROR_CHECK(err_code); +} + + +/** + * @brief Battery level collector initialization. + */ +static void bas_c_init(void) +{ + ble_bas_c_init_t bas_c_init_obj; + + bas_c_init_obj.evt_handler = bas_c_evt_handler; + + uint32_t err_code = ble_bas_c_init(&m_ble_bas_c, &bas_c_init_obj); + APP_ERROR_CHECK(err_code); +} + + +/** + * @brief Database discovery collector initialization. + */ +static void db_discovery_init(void) +{ + uint32_t err_code = ble_db_discovery_init(db_disc_handler); + + APP_ERROR_CHECK(err_code); +} + + +/**@brief Function to start scanning. + */ +static void scan_start(void) +{ + ble_gap_whitelist_t whitelist; + ble_gap_addr_t * p_whitelist_addr[BLE_GAP_WHITELIST_ADDR_MAX_COUNT]; + ble_gap_irk_t * p_whitelist_irk[BLE_GAP_WHITELIST_IRK_MAX_COUNT]; + uint32_t err_code; + uint32_t count; + + // Verify if there is any flash access pending, if yes delay starting scanning until + // it's complete. + err_code = pstorage_access_status_get(&count); + APP_ERROR_CHECK(err_code); + + if (count != 0) + { + m_memory_access_in_progress = true; + return; + } + + // Initialize whitelist parameters. + whitelist.addr_count = BLE_GAP_WHITELIST_ADDR_MAX_COUNT; + whitelist.irk_count = 0; + whitelist.pp_addrs = p_whitelist_addr; + whitelist.pp_irks = p_whitelist_irk; + + // Request creating of whitelist. + err_code = dm_whitelist_create(&m_dm_app_id,&whitelist); + APP_ERROR_CHECK(err_code); + + if (((whitelist.addr_count == 0) && (whitelist.irk_count == 0)) || + (m_scan_mode != BLE_WHITELIST_SCAN) || + (m_whitelist_temporarily_disabled)) + { + // No devices in whitelist, hence non selective performed. + m_scan_param.active = 0; // Active scanning set. + m_scan_param.selective = 0; // Selective scanning not set. + m_scan_param.interval = SCAN_INTERVAL;// Scan interval. + m_scan_param.window = SCAN_WINDOW; // Scan window. + m_scan_param.p_whitelist = NULL; // No whitelist provided. + m_scan_param.timeout = 0x0000; // No timeout. + } + else + { + // Selective scanning based on whitelist first. + m_scan_param.active = 0; // Active scanning set. + m_scan_param.selective = 1; // Selective scanning not set. + m_scan_param.interval = SCAN_INTERVAL;// Scan interval. + m_scan_param.window = SCAN_WINDOW; // Scan window. + m_scan_param.p_whitelist = &whitelist; // Provide whitelist. + m_scan_param.timeout = 0x001E; // 30 seconds timeout. + } + + err_code = sd_ble_gap_scan_start(&m_scan_param); + APP_ERROR_CHECK(err_code); + + err_code = bsp_indication_set(BSP_INDICATE_SCANNING); + APP_ERROR_CHECK(err_code); +} + + +/**@brief Function for initializing buttons and leds. + * + * @param[out] p_erase_bonds Will be true if the clear bonding button was pressed to wake the application up. + */ +static void buttons_leds_init(bool * p_erase_bonds) +{ + bsp_event_t startup_event; + + uint32_t err_code = bsp_init(BSP_INIT_LED | BSP_INIT_BUTTONS, + APP_TIMER_TICKS(100, APP_TIMER_PRESCALER), + bsp_event_handler); + APP_ERROR_CHECK(err_code); + + err_code = bsp_btn_ble_init(NULL, &startup_event); + APP_ERROR_CHECK(err_code); + + *p_erase_bonds = (startup_event == BSP_EVENT_CLEAR_BONDING_DATA); +} + + +/**@brief Function for initializing the nrf log module. + */ +static void nrf_log_init(void) +{ + ret_code_t err_code = NRF_LOG_INIT(); + APP_ERROR_CHECK(err_code); +} + + +/** @brief Function for the Power manager. + */ +static void power_manage(void) +{ + uint32_t err_code = sd_app_evt_wait(); + APP_ERROR_CHECK(err_code); +} + + +int main(void) +{ + bool erase_bonds; + + // Initialize. + APP_TIMER_INIT(APP_TIMER_PRESCALER, APP_TIMER_OP_QUEUE_SIZE, NULL); + buttons_leds_init(&erase_bonds); + nrf_log_init(); + APPL_LOG("Heart rate collector example\r\n"); + ble_stack_init(); + device_manager_init(erase_bonds); + db_discovery_init(); + hrs_c_init(); + bas_c_init(); + + // Start scanning for peripherals and initiate connection + // with devices that advertise Heart Rate UUID. + scan_start(); + + for (;; ) + { + power_manage(); + } +} + + +