HW: NRF52832 DK
SDK: 17.1
SD:S132_7.2
Sw: ble_uart_c
Issue: nRF52832 as a central to scan a peripheal(not nordic chip),the nRF Connect APP can discovery all the service, but in nRF52832 it can not disovery the primary service.I attched the peripheral service pincture. It have two customer service, 0xFFF0 is the primary service i want to discovery.And attched the log when discovery start.It always respond 0x10A error.
And i tried a nRF51822 board as ble peripheral, the central can discovery the primary service successfully.As follow picture shown.
But same cental code can not discovery the primary service.I attch the code modified in SDK example ble_uart_c.Please help me!Thanks!
/** * Copyright (c) 2014 - 2021, Nordic Semiconductor ASA * * All rights reserved. * * Redistribution and use in source and binary forms, with or without modification, * are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, this * list of conditions and the following disclaimer. * * 2. Redistributions in binary form, except as embedded into a Nordic * Semiconductor ASA integrated circuit in a product or a software update for * such product, must reproduce the above copyright notice, this list of * conditions and the following disclaimer in the documentation and/or other * materials provided with the distribution. * * 3. Neither the name of Nordic Semiconductor ASA nor the names of its * contributors may be used to endorse or promote products derived from this * software without specific prior written permission. * * 4. This software, with or without modification, must only be used with a * Nordic Semiconductor ASA integrated circuit. * * 5. Any software provided in binary form under this license must not be reverse * engineered, decompiled, modified and/or disassembled. * * THIS SOFTWARE IS PROVIDED BY NORDIC SEMICONDUCTOR ASA "AS IS" AND ANY EXPRESS * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES * OF MERCHANTABILITY, NONINFRINGEMENT, AND FITNESS FOR A PARTICULAR PURPOSE ARE * DISCLAIMED. IN NO EVENT SHALL NORDIC SEMICONDUCTOR ASA OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. * */ /** * @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 "ble_srv_common.h" #include "nrf_sdh.h" #include "nrf_sdh_ble.h" #include "nrf_sdh_soc.h" #include "nrf_pwr_mgmt.h" #include "app_util.h" #include "app_error.h" #include "peer_manager.h" #include "peer_manager_handler.h" #include "ble_hrs_c.h" #include "ble_bas_c.h" #include "app_util.h" #include "app_timer.h" #include "bsp_btn_ble.h" #include "fds.h" #include "nrf_fstorage.h" #include "ble_conn_state.h" #include "nrf_ble_gatt.h" #include "nrf_ble_lesc.h" #include "nrf_log.h" #include "nrf_log_ctrl.h" #include "nrf_log_default_backends.h" #include "nrf_ble_scan.h" #define APP_BLE_CONN_CFG_TAG 1 /**< A tag identifying the SoftDevice BLE configuration. */ #define APP_BLE_OBSERVER_PRIO 3 /**< Application's BLE observer priority. You shouldn't need to modify this value. */ #define APP_SOC_OBSERVER_PRIO 1 /**< Applications' SoC observer priority. You shouldn't need to modify this value. */ #define LESC_DEBUG_MODE 0 /**< Set to 1 to use LESC debug keys, allows you to use a sniffer to inspect traffic. */ #define SEC_PARAM_BOND 1 /**< Perform bonding. */ #define SEC_PARAM_MITM 0 /**< Man In The Middle protection not required. */ #define SEC_PARAM_LESC 1 /**< LE Secure Connections 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 in octets. */ #define SEC_PARAM_MAX_KEY_SIZE 16 /**< Maximum encryption key size in octets. */ #define SCAN_DURATION_WITELIST 3000 /**< Duration of the scanning in units of 10 milliseconds. */ #define TARGET_UUID BLE_UUID_HEART_RATE_SERVICE /**< Target device uuid that application is looking for. */ /**@brief 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) NRF_BLE_GQ_DEF(m_ble_gatt_queue, /**< BLE GATT Queue instance. */ NRF_SDH_BLE_CENTRAL_LINK_COUNT, NRF_BLE_GQ_QUEUE_SIZE); BLE_HRS_C_DEF(m_hrs_c); /**< Structure used to identify the heart rate client module. */ BLE_BAS_C_DEF(m_bas_c); /**< Structure used to identify the Battery Service client module. */ NRF_BLE_GATT_DEF(m_gatt); /**< GATT module instance. */ BLE_DB_DISCOVERY_DEF(m_db_disc); /**< DB discovery module instance. */ NRF_BLE_SCAN_DEF(m_scan); /**< Scanning module instance. */ static uint16_t m_conn_handle; /**< Current connection handle. */ static bool m_whitelist_disabled; /**< True if whitelist has been temporarily disabled. */ static bool m_memory_access_in_progress; /**< Flag to keep track of ongoing operations on persistent memory. */ /**< Scan parameters requested for scanning and connection. */ static ble_gap_scan_params_t const m_scan_param = { .active = 0x01, #if (NRF_SD_BLE_API_VERSION > 7) .interval_us = NRF_BLE_SCAN_SCAN_INTERVAL * UNIT_0_625_MS, .window_us = NRF_BLE_SCAN_SCAN_WINDOW * UNIT_0_625_MS, #else .interval = NRF_BLE_SCAN_SCAN_INTERVAL, .window = NRF_BLE_SCAN_SCAN_WINDOW, #endif // (NRF_SD_BLE_API_VERSION > 7) .filter_policy = BLE_GAP_SCAN_FP_WHITELIST, .timeout = SCAN_DURATION_WITELIST, .scan_phys = BLE_GAP_PHY_1MBPS, }; /**@brief Names which the central applications will scan for, and which will be advertised by the peripherals. * if these are set to empty strings, the UUIDs defined below will be used */ static char const m_target_periph_name[] = ""; /**< If you want to connect to a peripheral using a given advertising name, type its name here. */ static bool is_connect_per_addr = false; /**< If you want to connect to a peripheral with a given address, set this to true and put the correct address in the variable below. */ static ble_gap_addr_t const m_target_periph_addr = { /* Possible values for addr_type: BLE_GAP_ADDR_TYPE_PUBLIC, BLE_GAP_ADDR_TYPE_RANDOM_STATIC, BLE_GAP_ADDR_TYPE_RANDOM_PRIVATE_RESOLVABLE, BLE_GAP_ADDR_TYPE_RANDOM_PRIVATE_NON_RESOLVABLE. */ .addr_type = BLE_GAP_ADDR_TYPE_RANDOM_STATIC, .addr = {0x8D, 0xFE, 0x23, 0x86, 0x77, 0xD9} }; 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); } /**@brief Function for handling the Heart Rate Service Client and Battery Service Client errors. * * @param[in] nrf_error Error code containing information about what went wrong. */ static void service_error_handler(uint32_t nrf_error) { APP_ERROR_HANDLER(nrf_error); } /**@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_hrs_c, p_evt); ble_bas_on_db_disc_evt(&m_bas_c, p_evt); } /**@brief Function for handling Peer Manager events. * * @param[in] p_evt Peer Manager event. */ static void pm_evt_handler(pm_evt_t const * p_evt) { pm_handler_on_pm_evt(p_evt); pm_handler_disconnect_on_sec_failure(p_evt); pm_handler_flash_clean(p_evt); switch (p_evt->evt_id) { case PM_EVT_PEERS_DELETE_SUCCEEDED: // Bonds are deleted. Start scanning. scan_start(); break; default: break; } } /** * @brief Function for shutdown events. * * @param[in] event Shutdown type. */ static bool shutdown_handler(nrf_pwr_mgmt_evt_t event) { ret_code_t err_code; err_code = bsp_indication_set(BSP_INDICATE_IDLE); APP_ERROR_CHECK(err_code); switch (event) { case NRF_PWR_MGMT_EVT_PREPARE_WAKEUP: // Prepare wakeup buttons. err_code = bsp_btn_ble_sleep_mode_prepare(); APP_ERROR_CHECK(err_code); break; default: break; } return true; } NRF_PWR_MGMT_HANDLER_REGISTER(shutdown_handler, APP_SHUTDOWN_HANDLER_PRIORITY); /**@brief Function for handling BLE events. * * @param[in] p_ble_evt Bluetooth stack event. * @param[in] p_context Unused. */ static void ble_evt_handler(ble_evt_t const * p_ble_evt, void * p_context) { ret_code_t err_code; ble_gap_evt_t const * p_gap_evt = &p_ble_evt->evt.gap_evt; switch (p_ble_evt->header.evt_id) { case BLE_GAP_EVT_CONNECTED: { NRF_LOG_INFO("Connected."); // Discover peer's services. err_code = ble_db_discovery_start(&m_db_disc, p_ble_evt->evt.gap_evt.conn_handle); APP_ERROR_CHECK(err_code); err_code = bsp_indication_set(BSP_INDICATE_CONNECTED); APP_ERROR_CHECK(err_code); if (ble_conn_state_central_conn_count() < NRF_SDH_BLE_CENTRAL_LINK_COUNT) { scan_start(); } } break; case BLE_GAP_EVT_DISCONNECTED: { NRF_LOG_INFO("Disconnected, reason 0x%x.", p_gap_evt->params.disconnected.reason); err_code = bsp_indication_set(BSP_INDICATE_IDLE); APP_ERROR_CHECK(err_code); if (ble_conn_state_central_conn_count() < NRF_SDH_BLE_CENTRAL_LINK_COUNT) { scan_start(); } } break; case BLE_GAP_EVT_TIMEOUT: { if (p_gap_evt->params.timeout.src == BLE_GAP_TIMEOUT_SRC_CONN) { NRF_LOG_INFO("Connection Request timed out."); } } 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; case BLE_GAP_EVT_PHY_UPDATE_REQUEST: { NRF_LOG_DEBUG("PHY update request."); ble_gap_phys_t const phys = { .rx_phys = BLE_GAP_PHY_AUTO, .tx_phys = BLE_GAP_PHY_AUTO, }; err_code = sd_ble_gap_phy_update(p_ble_evt->evt.gap_evt.conn_handle, &phys); APP_ERROR_CHECK(err_code); } break; case BLE_GATTC_EVT_TIMEOUT: // Disconnect on GATT Client timeout event. NRF_LOG_DEBUG("GATT Client Timeout."); err_code = sd_ble_gap_disconnect(p_ble_evt->evt.gattc_evt.conn_handle, BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION); APP_ERROR_CHECK(err_code); break; case BLE_GATTS_EVT_TIMEOUT: // Disconnect on GATT Server timeout event. NRF_LOG_DEBUG("GATT Server Timeout."); err_code = sd_ble_gap_disconnect(p_ble_evt->evt.gatts_evt.conn_handle, BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION); APP_ERROR_CHECK(err_code); break; case BLE_GAP_EVT_SEC_PARAMS_REQUEST: NRF_LOG_DEBUG("BLE_GAP_EVT_SEC_PARAMS_REQUEST"); break; case BLE_GAP_EVT_AUTH_KEY_REQUEST: NRF_LOG_INFO("BLE_GAP_EVT_AUTH_KEY_REQUEST"); break; case BLE_GAP_EVT_LESC_DHKEY_REQUEST: NRF_LOG_INFO("BLE_GAP_EVT_LESC_DHKEY_REQUEST"); break; case BLE_GAP_EVT_AUTH_STATUS: NRF_LOG_INFO("BLE_GAP_EVT_AUTH_STATUS: status=0x%x bond=0x%x lv4: %d kdist_own:0x%x kdist_peer:0x%x", p_ble_evt->evt.gap_evt.params.auth_status.auth_status, p_ble_evt->evt.gap_evt.params.auth_status.bonded, p_ble_evt->evt.gap_evt.params.auth_status.sm1_levels.lv4, *((uint8_t *)&p_ble_evt->evt.gap_evt.params.auth_status.kdist_own), *((uint8_t *)&p_ble_evt->evt.gap_evt.params.auth_status.kdist_peer)); break; default: break; } } /**@brief SoftDevice SoC event handler. * * @param[in] evt_id SoC event. * @param[in] p_context Context. */ static void soc_evt_handler(uint32_t evt_id, void * p_context) { switch (evt_id) { 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 initializing the BLE stack. * * @details Initializes the SoftDevice and the BLE event interrupt. */ static void ble_stack_init(void) { ret_code_t err_code; err_code = nrf_sdh_enable_request(); APP_ERROR_CHECK(err_code); // Configure the BLE stack using the default settings. // Fetch the start address of the application RAM. uint32_t ram_start = 0; err_code = nrf_sdh_ble_default_cfg_set(APP_BLE_CONN_CFG_TAG, &ram_start); APP_ERROR_CHECK(err_code); // Enable BLE stack. err_code = nrf_sdh_ble_enable(&ram_start); APP_ERROR_CHECK(err_code); // Register handlers for BLE and SoC events. NRF_SDH_BLE_OBSERVER(m_ble_observer, APP_BLE_OBSERVER_PRIO, ble_evt_handler, NULL); NRF_SDH_SOC_OBSERVER(m_soc_observer, APP_SOC_OBSERVER_PRIO, soc_evt_handler, NULL); } /**@brief Function for the Peer Manager initialization. */ static void peer_manager_init(void) { ble_gap_sec_params_t sec_param; ret_code_t err_code; err_code = pm_init(); APP_ERROR_CHECK(err_code); memset(&sec_param, 0, sizeof(ble_gap_sec_params_t)); // Security parameters to be used for all security procedures. sec_param.bond = SEC_PARAM_BOND; sec_param.mitm = SEC_PARAM_MITM; sec_param.lesc = SEC_PARAM_LESC; sec_param.keypress = SEC_PARAM_KEYPRESS; sec_param.io_caps = SEC_PARAM_IO_CAPABILITIES; sec_param.oob = SEC_PARAM_OOB; sec_param.min_key_size = SEC_PARAM_MIN_KEY_SIZE; sec_param.max_key_size = SEC_PARAM_MAX_KEY_SIZE; sec_param.kdist_own.enc = 1; sec_param.kdist_own.id = 1; sec_param.kdist_peer.enc = 1; sec_param.kdist_peer.id = 1; err_code = pm_sec_params_set(&sec_param); APP_ERROR_CHECK(err_code); err_code = pm_register(pm_evt_handler); APP_ERROR_CHECK(err_code); } /** @brief Clear bonding information from persistent storage */ static void delete_bonds(void) { ret_code_t err_code; NRF_LOG_INFO("Erase bonds!"); err_code = pm_peers_delete(); APP_ERROR_CHECK(err_code); } /**@brief Function for disabling the use of whitelist for scanning. */ static void whitelist_disable(void) { if (!m_whitelist_disabled) { NRF_LOG_INFO("Whitelist temporarily disabled."); m_whitelist_disabled = true; nrf_ble_scan_stop(); scan_start(); } } /**@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) { ret_code_t err_code; switch (event) { case BSP_EVENT_SLEEP: nrf_pwr_mgmt_shutdown(NRF_PWR_MGMT_SHUTDOWN_GOTO_SYSOFF); 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) { ret_code_t err_code; switch (p_hrs_c_evt->evt_type) { case BLE_HRS_C_EVT_DISCOVERY_COMPLETE: { NRF_LOG_DEBUG("Heart rate service discovered."); err_code = ble_hrs_c_handles_assign(p_hrs_c, p_hrs_c_evt->conn_handle, &p_hrs_c_evt->params.peer_db); APP_ERROR_CHECK(err_code); // 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); } break; case BLE_HRS_C_EVT_HRM_NOTIFICATION: { NRF_LOG_INFO("Heart Rate = %d.", p_hrs_c_evt->params.hrm.hr_value); if (p_hrs_c_evt->params.hrm.rr_intervals_cnt != 0) { uint32_t rr_avg = 0; for (uint32_t i = 0; i < p_hrs_c_evt->params.hrm.rr_intervals_cnt; i++) { rr_avg += p_hrs_c_evt->params.hrm.rr_intervals[i]; } rr_avg = rr_avg / p_hrs_c_evt->params.hrm.rr_intervals_cnt; NRF_LOG_DEBUG("rr_interval (avg) = %d.", rr_avg); } } break; default: break; } } /**@brief Battery level Collector Handler. */ static void bas_c_evt_handler(ble_bas_c_t * p_bas_c, ble_bas_c_evt_t * p_bas_c_evt) { ret_code_t err_code; switch (p_bas_c_evt->evt_type) { case BLE_BAS_C_EVT_DISCOVERY_COMPLETE: { err_code = ble_bas_c_handles_assign(p_bas_c, p_bas_c_evt->conn_handle, &p_bas_c_evt->params.bas_db); APP_ERROR_CHECK(err_code); // Battery service discovered. Enable notification of Battery Level. NRF_LOG_DEBUG("Battery Service discovered. Reading battery level."); err_code = ble_bas_c_bl_read(p_bas_c); APP_ERROR_CHECK(err_code); NRF_LOG_DEBUG("Enabling Battery Level Notification."); err_code = ble_bas_c_bl_notif_enable(p_bas_c); APP_ERROR_CHECK(err_code); } break; case BLE_BAS_C_EVT_BATT_NOTIFICATION: NRF_LOG_INFO("Battery Level received %d %%.", p_bas_c_evt->params.battery_level); break; case BLE_BAS_C_EVT_BATT_READ_RESP: NRF_LOG_INFO("Battery Level Read as %d %%.", 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; hrs_c_init_obj.error_handler = service_error_handler; hrs_c_init_obj.p_gatt_queue = &m_ble_gatt_queue; ret_code_t err_code = ble_hrs_c_init(&m_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; bas_c_init_obj.error_handler = service_error_handler; bas_c_init_obj.p_gatt_queue = &m_ble_gatt_queue; ret_code_t err_code = ble_bas_c_init(&m_bas_c, &bas_c_init_obj); APP_ERROR_CHECK(err_code); } /** * @brief Database discovery collector initialization. */ static void db_discovery_init(void) { ble_db_discovery_init_t db_init; memset(&db_init, 0, sizeof(db_init)); db_init.evt_handler = db_disc_handler; db_init.p_gatt_queue = &m_ble_gatt_queue; ret_code_t err_code = ble_db_discovery_init(&db_init); APP_ERROR_CHECK(err_code); } /**@brief Retrieve a list of peer manager peer IDs. * * @param[inout] p_peers The buffer where to store the list of peer IDs. * @param[inout] p_size In: The size of the @p p_peers buffer. * Out: The number of peers copied in the buffer. */ static void peer_list_get(pm_peer_id_t * p_peers, uint32_t * p_size) { pm_peer_id_t peer_id; uint32_t peers_to_copy; peers_to_copy = (*p_size < BLE_GAP_WHITELIST_ADDR_MAX_COUNT) ? *p_size : BLE_GAP_WHITELIST_ADDR_MAX_COUNT; peer_id = pm_next_peer_id_get(PM_PEER_ID_INVALID); *p_size = 0; while ((peer_id != PM_PEER_ID_INVALID) && (peers_to_copy--)) { p_peers[(*p_size)++] = peer_id; peer_id = pm_next_peer_id_get(peer_id); } } static void whitelist_load() { ret_code_t ret; pm_peer_id_t peers[8]; uint32_t peer_cnt; memset(peers, PM_PEER_ID_INVALID, sizeof(peers)); peer_cnt = (sizeof(peers) / sizeof(pm_peer_id_t)); // Load all peers from flash and whitelist them. peer_list_get(peers, &peer_cnt); ret = pm_whitelist_set(peers, peer_cnt); APP_ERROR_CHECK(ret); // Setup the device identies list. // Some SoftDevices do not support this feature. ret = pm_device_identities_list_set(peers, peer_cnt); if (ret != NRF_ERROR_NOT_SUPPORTED) { APP_ERROR_CHECK(ret); } } static void on_whitelist_req(void) { ret_code_t err_code; // Whitelist buffers. ble_gap_addr_t whitelist_addrs[8]; ble_gap_irk_t whitelist_irks[8]; memset(whitelist_addrs, 0x00, sizeof(whitelist_addrs)); memset(whitelist_irks, 0x00, sizeof(whitelist_irks)); uint32_t addr_cnt = (sizeof(whitelist_addrs) / sizeof(ble_gap_addr_t)); uint32_t irk_cnt = (sizeof(whitelist_irks) / sizeof(ble_gap_irk_t)); // Reload the whitelist and whitelist all peers. whitelist_load(); // Get the whitelist previously set using pm_whitelist_set(). err_code = pm_whitelist_get(whitelist_addrs, &addr_cnt, whitelist_irks, &irk_cnt); if (((addr_cnt == 0) && (irk_cnt == 0)) || (m_whitelist_disabled)) { // Don't use whitelist. err_code = nrf_ble_scan_params_set(&m_scan, NULL); APP_ERROR_CHECK(err_code); } } /**@brief Function to start scanning. */ static void scan_start(void) { ret_code_t err_code; if (nrf_fstorage_is_busy(NULL)) { m_memory_access_in_progress = true; return; } NRF_LOG_INFO("Starting scan."); err_code = nrf_ble_scan_start(&m_scan); 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) { ret_code_t err_code; bsp_event_t startup_event; err_code = bsp_init(BSP_INIT_LEDS | BSP_INIT_BUTTONS, 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 log_init(void) { ret_code_t err_code = NRF_LOG_INIT(NULL); APP_ERROR_CHECK(err_code); NRF_LOG_DEFAULT_BACKENDS_INIT(); } /**@brief Function for initializing the power management module. */ static void power_management_init(void) { ret_code_t err_code; err_code = nrf_pwr_mgmt_init(); APP_ERROR_CHECK(err_code); } /**@brief GATT module event handler. */ static void gatt_evt_handler(nrf_ble_gatt_t * p_gatt, nrf_ble_gatt_evt_t const * p_evt) { switch (p_evt->evt_id) { case NRF_BLE_GATT_EVT_ATT_MTU_UPDATED: { NRF_LOG_INFO("GATT ATT MTU on connection 0x%x changed to %d.", p_evt->conn_handle, p_evt->params.att_mtu_effective); } break; case NRF_BLE_GATT_EVT_DATA_LENGTH_UPDATED: { NRF_LOG_INFO("Data length for connection 0x%x updated to %d.", p_evt->conn_handle, p_evt->params.data_length); } break; default: break; } } static void scan_evt_handler(scan_evt_t const * p_scan_evt) { ret_code_t err_code; switch(p_scan_evt->scan_evt_id) { case NRF_BLE_SCAN_EVT_WHITELIST_REQUEST: { on_whitelist_req(); m_whitelist_disabled = false; } break; case NRF_BLE_SCAN_EVT_CONNECTING_ERROR: { err_code = p_scan_evt->params.connecting_err.err_code; APP_ERROR_CHECK(err_code); } break; case NRF_BLE_SCAN_EVT_SCAN_TIMEOUT: { NRF_LOG_INFO("Scan timed out."); scan_start(); } break; case NRF_BLE_SCAN_EVT_FILTER_MATCH: break; case NRF_BLE_SCAN_EVT_WHITELIST_ADV_REPORT: break; default: break; } } /**@brief Function for initializing the timer. */ static void timer_init(void) { ret_code_t err_code = app_timer_init(); APP_ERROR_CHECK(err_code); } /**@brief Function for initializing the GATT module. */ static void gatt_init(void) { ret_code_t err_code = nrf_ble_gatt_init(&m_gatt, gatt_evt_handler); APP_ERROR_CHECK(err_code); } /**@brief Function for initialization scanning and setting filters. */ static void scan_init(void) { ret_code_t err_code; nrf_ble_scan_init_t init_scan; memset(&init_scan, 0, sizeof(init_scan)); init_scan.p_scan_param = &m_scan_param; init_scan.connect_if_match = true; init_scan.conn_cfg_tag = APP_BLE_CONN_CFG_TAG; err_code = nrf_ble_scan_init(&m_scan, &init_scan, scan_evt_handler); APP_ERROR_CHECK(err_code); ble_uuid_t uuid = { .uuid = TARGET_UUID, .type = BLE_UUID_TYPE_BLE, }; err_code = nrf_ble_scan_filter_set(&m_scan, SCAN_UUID_FILTER, &uuid); APP_ERROR_CHECK(err_code); if (strlen(m_target_periph_name) != 0) { err_code = nrf_ble_scan_filter_set(&m_scan, SCAN_NAME_FILTER, m_target_periph_name); APP_ERROR_CHECK(err_code); } if (is_connect_per_addr) { err_code = nrf_ble_scan_filter_set(&m_scan, SCAN_ADDR_FILTER, m_target_periph_addr.addr); APP_ERROR_CHECK(err_code); } err_code = nrf_ble_scan_filters_enable(&m_scan, NRF_BLE_SCAN_ALL_FILTER, false); APP_ERROR_CHECK(err_code); } /**@brief Function for handling the idle state (main loop). * * @details Handle any pending log operation(s), then sleep until the next event occurs. */ static void idle_state_handle(void) { ret_code_t err_code; err_code = nrf_ble_lesc_request_handler(); APP_ERROR_CHECK(err_code); NRF_LOG_FLUSH(); nrf_pwr_mgmt_run(); } /**@brief Function for starting a scan, or instead trigger it from peer manager (after * deleting bonds). * * @param[in] p_erase_bonds Pointer to a bool to determine if bonds will be deleted before scanning. */ void scanning_start(bool * p_erase_bonds) { // Start scanning for peripherals and initiate connection // with devices that advertise GATT Service UUID. if (*p_erase_bonds == true) { // Scan is started by the PM_EVT_PEERS_DELETE_SUCCEEDED event. delete_bonds(); } else { scan_start(); } } int main(void) { bool erase_bonds; // Initialize. log_init(); timer_init(); power_management_init(); buttons_leds_init(&erase_bonds); ble_stack_init(); gatt_init(); peer_manager_init(); db_discovery_init(); hrs_c_init(); bas_c_init(); scan_init(); // Start execution. NRF_LOG_INFO("Heart Rate collector example started."); scanning_start(&erase_bonds); // Enter main loop. for (;;) { idle_state_handle(); } }
/** * Copyright (c) 2012 - 2021, Nordic Semiconductor ASA * * All rights reserved. * * Redistribution and use in source and binary forms, with or without modification, * are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, this * list of conditions and the following disclaimer. * * 2. Redistributions in binary form, except as embedded into a Nordic * Semiconductor ASA integrated circuit in a product or a software update for * such product, must reproduce the above copyright notice, this list of * conditions and the following disclaimer in the documentation and/or other * materials provided with the distribution. * * 3. Neither the name of Nordic Semiconductor ASA nor the names of its * contributors may be used to endorse or promote products derived from this * software without specific prior written permission. * * 4. This software, with or without modification, must only be used with a * Nordic Semiconductor ASA integrated circuit. * * 5. Any software provided in binary form under this license must not be reverse * engineered, decompiled, modified and/or disassembled. * * THIS SOFTWARE IS PROVIDED BY NORDIC SEMICONDUCTOR ASA "AS IS" AND ANY EXPRESS * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES * OF MERCHANTABILITY, NONINFRINGEMENT, AND FITNESS FOR A PARTICULAR PURPOSE ARE * DISCLAIMED. IN NO EVENT SHALL NORDIC SEMICONDUCTOR ASA OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. * */ #include "sdk_common.h" #if NRF_MODULE_ENABLED(BLE_NUS_C) #include <stdlib.h> #include "ble.h" #include "ble_nus_c.h" #include "ble_gattc.h" #include "ble_srv_common.h" #include "app_error.h" #define NRF_LOG_MODULE_NAME ble_nus_c #include "nrf_log.h" NRF_LOG_MODULE_REGISTER(); /**@brief Function for intercepting the errors of GATTC and the BLE GATT Queue. * * @param[in] nrf_error Error code. * @param[in] p_ctx Parameter from the event handler. * @param[in] conn_handle Connection handle. */ static void gatt_error_handler(uint32_t nrf_error, void * p_ctx, uint16_t conn_handle) { ble_nus_c_t * p_ble_nus_c = (ble_nus_c_t *)p_ctx; NRF_LOG_DEBUG("A GATT Client error has occurred on conn_handle: 0X%X", conn_handle); if (p_ble_nus_c->error_handler != NULL) { p_ble_nus_c->error_handler(nrf_error); } } void ble_nus_c_on_db_disc_evt(ble_nus_c_t * p_ble_nus_c, ble_db_discovery_evt_t * p_evt) { ble_nus_c_evt_t nus_c_evt; memset(&nus_c_evt,0,sizeof(ble_nus_c_evt_t)); ble_gatt_db_char_t * p_chars = p_evt->params.discovered_db.charateristics; // Check if the NUS was discovered. if ( (p_evt->evt_type == BLE_DB_DISCOVERY_COMPLETE) && (p_evt->params.discovered_db.srv_uuid.uuid == BLE_UUID_NUS_SERVICE) && (p_evt->params.discovered_db.srv_uuid.type == BLE_UUID_TYPE_BLE /*p_ble_nus_c->uuid_type*/)) { for (uint32_t i = 0; i < p_evt->params.discovered_db.char_count; i++) { switch (p_chars[i].characteristic.uuid.uuid) { case BLE_UUID_NUS_RX_CHARACTERISTIC: nus_c_evt.handles.nus_rx_handle = p_chars[i].characteristic.handle_value; break; case BLE_UUID_NUS_TX_CHARACTERISTIC: nus_c_evt.handles.nus_tx_handle = p_chars[i].characteristic.handle_value; nus_c_evt.handles.nus_tx_cccd_handle = p_chars[i].cccd_handle; break; default: break; } } if (p_ble_nus_c->evt_handler != NULL) { nus_c_evt.conn_handle = p_evt->conn_handle; nus_c_evt.evt_type = BLE_NUS_C_EVT_DISCOVERY_COMPLETE; p_ble_nus_c->evt_handler(p_ble_nus_c, &nus_c_evt); } } } /**@brief Function for handling Handle Value Notification received from the SoftDevice. * * @details This function uses the Handle Value Notification received from the SoftDevice * and checks if it is a notification of the NUS TX characteristic from the peer. * If it is, this function decodes the data and sends it to the application. * * @param[in] p_ble_nus_c Pointer to the NUS Client structure. * @param[in] p_ble_evt Pointer to the BLE event received. */ static void on_hvx(ble_nus_c_t * p_ble_nus_c, ble_evt_t const * p_ble_evt) { // HVX can only occur from client sending. if ( (p_ble_nus_c->handles.nus_tx_handle != BLE_GATT_HANDLE_INVALID) && (p_ble_evt->evt.gattc_evt.params.hvx.handle == p_ble_nus_c->handles.nus_tx_handle) && (p_ble_nus_c->evt_handler != NULL)) { ble_nus_c_evt_t ble_nus_c_evt; ble_nus_c_evt.evt_type = BLE_NUS_C_EVT_NUS_TX_EVT; ble_nus_c_evt.p_data = (uint8_t *)p_ble_evt->evt.gattc_evt.params.hvx.data; ble_nus_c_evt.data_len = p_ble_evt->evt.gattc_evt.params.hvx.len; p_ble_nus_c->evt_handler(p_ble_nus_c, &ble_nus_c_evt); NRF_LOG_DEBUG("Client sending data."); } } uint32_t ble_nus_c_init(ble_nus_c_t * p_ble_nus_c, ble_nus_c_init_t * p_ble_nus_c_init) { uint32_t err_code; ble_uuid_t uart_uuid; // ble_uuid128_t nus_base_uuid = NUS_BASE_UUID; VERIFY_PARAM_NOT_NULL(p_ble_nus_c); VERIFY_PARAM_NOT_NULL(p_ble_nus_c_init); VERIFY_PARAM_NOT_NULL(p_ble_nus_c_init->p_gatt_queue); // err_code = sd_ble_uuid_vs_add(&nus_base_uuid, &p_ble_nus_c->uuid_type); // VERIFY_SUCCESS(err_code); uart_uuid.type = BLE_UUID_TYPE_BLE; //p_ble_nus_c->uuid_type; uart_uuid.uuid = BLE_UUID_NUS_SERVICE; p_ble_nus_c->conn_handle = BLE_CONN_HANDLE_INVALID; p_ble_nus_c->evt_handler = p_ble_nus_c_init->evt_handler; p_ble_nus_c->error_handler = p_ble_nus_c_init->error_handler; p_ble_nus_c->handles.nus_tx_handle = BLE_GATT_HANDLE_INVALID; p_ble_nus_c->handles.nus_rx_handle = BLE_GATT_HANDLE_INVALID; p_ble_nus_c->p_gatt_queue = p_ble_nus_c_init->p_gatt_queue; return ble_db_discovery_evt_register(&uart_uuid); } void ble_nus_c_on_ble_evt(ble_evt_t const * p_ble_evt, void * p_context) { ble_nus_c_t * p_ble_nus_c = (ble_nus_c_t *)p_context; if ((p_ble_nus_c == NULL) || (p_ble_evt == NULL)) { return; } if ( (p_ble_nus_c->conn_handle == BLE_CONN_HANDLE_INVALID) ||(p_ble_nus_c->conn_handle != p_ble_evt->evt.gap_evt.conn_handle) ) { return; } switch (p_ble_evt->header.evt_id) { case BLE_GATTC_EVT_HVX: on_hvx(p_ble_nus_c, p_ble_evt); break; case BLE_GAP_EVT_DISCONNECTED: if (p_ble_evt->evt.gap_evt.conn_handle == p_ble_nus_c->conn_handle && p_ble_nus_c->evt_handler != NULL) { ble_nus_c_evt_t nus_c_evt; nus_c_evt.evt_type = BLE_NUS_C_EVT_DISCONNECTED; p_ble_nus_c->conn_handle = BLE_CONN_HANDLE_INVALID; p_ble_nus_c->evt_handler(p_ble_nus_c, &nus_c_evt); } break; default: // No implementation needed. break; } } /**@brief Function for creating a message for writing to the CCCD. */ static uint32_t cccd_configure(ble_nus_c_t * p_ble_nus_c, bool notification_enable) { nrf_ble_gq_req_t cccd_req; uint8_t cccd[BLE_CCCD_VALUE_LEN]; uint16_t cccd_val = notification_enable ? BLE_GATT_HVX_NOTIFICATION : 0; memset(&cccd_req, 0, sizeof(nrf_ble_gq_req_t)); cccd[0] = LSB_16(cccd_val); cccd[1] = MSB_16(cccd_val); cccd_req.type = NRF_BLE_GQ_REQ_GATTC_WRITE; cccd_req.error_handler.cb = gatt_error_handler; cccd_req.error_handler.p_ctx = p_ble_nus_c; cccd_req.params.gattc_write.handle = p_ble_nus_c->handles.nus_tx_cccd_handle; cccd_req.params.gattc_write.len = BLE_CCCD_VALUE_LEN; cccd_req.params.gattc_write.offset = 0; cccd_req.params.gattc_write.p_value = cccd; cccd_req.params.gattc_write.write_op = BLE_GATT_OP_WRITE_REQ; cccd_req.params.gattc_write.flags = BLE_GATT_EXEC_WRITE_FLAG_PREPARED_WRITE; return nrf_ble_gq_item_add(p_ble_nus_c->p_gatt_queue, &cccd_req, p_ble_nus_c->conn_handle); } uint32_t ble_nus_c_tx_notif_enable(ble_nus_c_t * p_ble_nus_c) { VERIFY_PARAM_NOT_NULL(p_ble_nus_c); if ( (p_ble_nus_c->conn_handle == BLE_CONN_HANDLE_INVALID) ||(p_ble_nus_c->handles.nus_tx_cccd_handle == BLE_GATT_HANDLE_INVALID) ) { return NRF_ERROR_INVALID_STATE; } return cccd_configure(p_ble_nus_c, true); } uint32_t ble_nus_c_string_send(ble_nus_c_t * p_ble_nus_c, uint8_t * p_string, uint16_t length) { VERIFY_PARAM_NOT_NULL(p_ble_nus_c); nrf_ble_gq_req_t write_req; memset(&write_req, 0, sizeof(nrf_ble_gq_req_t)); if (length > BLE_NUS_MAX_DATA_LEN) { NRF_LOG_WARNING("Content too long."); return NRF_ERROR_INVALID_PARAM; } if (p_ble_nus_c->conn_handle == BLE_CONN_HANDLE_INVALID) { NRF_LOG_WARNING("Connection handle invalid."); return NRF_ERROR_INVALID_STATE; } write_req.type = NRF_BLE_GQ_REQ_GATTC_WRITE; write_req.error_handler.cb = gatt_error_handler; write_req.error_handler.p_ctx = p_ble_nus_c; write_req.params.gattc_write.handle = p_ble_nus_c->handles.nus_rx_handle; write_req.params.gattc_write.len = length; write_req.params.gattc_write.offset = 0; write_req.params.gattc_write.p_value = p_string; write_req.params.gattc_write.write_op = BLE_GATT_OP_WRITE_CMD; write_req.params.gattc_write.flags = BLE_GATT_EXEC_WRITE_FLAG_PREPARED_WRITE; return nrf_ble_gq_item_add(p_ble_nus_c->p_gatt_queue, &write_req, p_ble_nus_c->conn_handle); } uint32_t ble_nus_c_handles_assign(ble_nus_c_t * p_ble_nus, uint16_t conn_handle, ble_nus_c_handles_t const * p_peer_handles) { VERIFY_PARAM_NOT_NULL(p_ble_nus); p_ble_nus->conn_handle = conn_handle; if (p_peer_handles != NULL) { p_ble_nus->handles.nus_tx_cccd_handle = p_peer_handles->nus_tx_cccd_handle; p_ble_nus->handles.nus_tx_handle = p_peer_handles->nus_tx_handle; p_ble_nus->handles.nus_rx_handle = p_peer_handles->nus_rx_handle; } return nrf_ble_gq_conn_handle_register(p_ble_nus->p_gatt_queue, conn_handle); } #endif // NRF_MODULE_ENABLED(BLE_NUS_C)