Junichi Katsu
test
Fork of
nRF51822
by 
Lancaster University
Diff: source/btle/btle.cpp
- Revision:
- 615:65ea2acfc6a2
- Parent:
- 592:f9574772b816
- Child:
- 616:a8f9b022d8fd
--- a/source/btle/btle.cpp Tue Jan 12 19:58:02 2016 +0000
+++ b/source/btle/btle.cpp Wed Apr 06 22:38:43 2016 +0100
@@ -1,248 +1,236 @@
-/* mbed Microcontroller Library
- * Copyright (c) 2006-2013 ARM Limited
- *
- * Licensed under the Apache License, Version 2.0 (the "License");
- * you may not use this file except in compliance with the License.
- * You may obtain a copy of the License at
- *
- * http://www.apache.org/licenses/LICENSE-2.0
- *
- * Unless required by applicable law or agreed to in writing, software
- * distributed under the License is distributed on an "AS IS" BASIS,
- * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
- * See the License for the specific language governing permissions and
- * limitations under the License.
- */
-
-#include "common/common.h"
-#include "nordic_common.h"
-
-#include "btle.h"
-
-#include "ble_flash.h"
-#include "ble_conn_params.h"
-
-#include "btle_gap.h"
-#include "btle_advertising.h"
-#include "custom/custom_helper.h"
-
-#include "ble/GapEvents.h"
-#include "nRF5xn.h"
-
-extern "C" {
-#include "pstorage.h"
-#include "device_manager.h"
-#include "softdevice_handler.h"
-#include "ble_stack_handler_types.h"
-}
-
-#include "ble_hci.h"
-#include "btle_discovery.h"
-
-#include "nRF5xGattClient.h"
-#include "nRF5xServiceDiscovery.h"
-#include "nRF5xCharacteristicDescriptorDiscoverer.h"
-
-extern "C" void assert_nrf_callback(uint16_t line_num, const uint8_t *p_file_name);
-void app_error_handler(uint32_t error_code, uint32_t line_num, const uint8_t *p_file_name);
-
-static void btle_handler(ble_evt_t *p_ble_evt);
-
-static void sys_evt_dispatch(uint32_t sys_evt)
-{
- pstorage_sys_event_handler(sys_evt);
-}
-
-/**
- * This function is called in interrupt context to handle BLE events; i.e. pull
- * system and user events out of the pending events-queue of the BLE stack. The
- * BLE stack signals the availability of events by the triggering the SWI2
- * interrupt, which forwards the handling to this function.
- *
- * The event processing loop is implemented in intern_softdevice_events_execute().
- *
- * In mbed OS, a callback for intern_softdevice_events_execute() is posted
- * to the scheduler, which then executes in thread mode. In mbed-classic,
- * event processing happens right-away in interrupt context (which is more
- * risk-prone). In either case, the logic of event processing is identical.
- */
-static uint32_t eventHandler()
-{
-#ifdef YOTTA_CFG_MBED_OS
- minar::Scheduler::postCallback(intern_softdevice_events_execute);
-#else
- intern_softdevice_events_execute();
-#endif
-
- return NRF_SUCCESS;
-}
-
-error_t btle_init(void)
-{
- nrf_clock_lfclksrc_t clockSource;
- if (NRF_CLOCK->LFCLKSRC & (CLOCK_LFCLKSRC_SRC_Xtal << CLOCK_LFCLKSRC_SRC_Pos)) {
- clockSource = NRF_CLOCK_LFCLKSRC_XTAL_20_PPM;
- } else {
- clockSource = NRF_CLOCK_LFCLKSRC_RC_250_PPM_4000MS_CALIBRATION;
- }
- SOFTDEVICE_HANDLER_INIT(clockSource, eventHandler);
-
- // Enable BLE stack
- /**
- * Using this call, the application can select whether to include the
- * Service Changed characteristic in the GATT Server. The default in all
- * previous releases has been to include the Service Changed characteristic,
- * but this affects how GATT clients behave. Specifically, it requires
- * clients to subscribe to this attribute and not to cache attribute handles
- * between connections unless the devices are bonded. If the application
- * does not need to change the structure of the GATT server attributes at
- * runtime this adds unnecessary complexity to the interaction with peer
- * clients. If the SoftDevice is enabled with the Service Changed
- * Characteristics turned off, then clients are allowed to cache attribute
- * handles making applications simpler on both sides.
- */
- static const bool IS_SRVC_CHANGED_CHARACT_PRESENT = true;
- ble_enable_params_t enableParams = {
- .gatts_enable_params = {
- .service_changed = IS_SRVC_CHANGED_CHARACT_PRESENT
- }
- };
- if (sd_ble_enable(&enableParams) != NRF_SUCCESS) {
- return ERROR_INVALID_PARAM;
- }
-
- ble_gap_addr_t addr;
- if (sd_ble_gap_address_get(&addr) != NRF_SUCCESS) {
- return ERROR_INVALID_PARAM;
- }
- if (sd_ble_gap_address_set(BLE_GAP_ADDR_CYCLE_MODE_NONE, &addr) != NRF_SUCCESS) {
- return ERROR_INVALID_PARAM;
- }
-
- ASSERT_STATUS( softdevice_ble_evt_handler_set(btle_handler));
- ASSERT_STATUS( softdevice_sys_evt_handler_set(sys_evt_dispatch));
-
- return btle_gap_init();
-}
-
-static void btle_handler(ble_evt_t *p_ble_evt)
-{
- /* Library service handlers */
-#if SDK_CONN_PARAMS_MODULE_ENABLE
- ble_conn_params_on_ble_evt(p_ble_evt);
-#endif
-
- dm_ble_evt_handler(p_ble_evt);
-
-#if !defined(TARGET_MCU_NRF51_16K_S110) && !defined(TARGET_MCU_NRF51_32K_S110)
- bleGattcEventHandler(p_ble_evt);
-#endif
-
- nRF5xn &ble = nRF5xn::Instance(BLE::DEFAULT_INSTANCE);
- nRF5xGap &gap = (nRF5xGap &) ble.getGap();
- nRF5xGattServer &gattServer = (nRF5xGattServer &) ble.getGattServer();
- nRF5xSecurityManager &securityManager = (nRF5xSecurityManager &) ble.getSecurityManager();
-
- /* Custom event handler */
- switch (p_ble_evt->header.evt_id) {
- case BLE_GAP_EVT_CONNECTED: {
- Gap::Handle_t handle = p_ble_evt->evt.gap_evt.conn_handle;
-#if defined(TARGET_MCU_NRF51_16K_S110) || defined(TARGET_MCU_NRF51_32K_S110)
- /* Only peripheral role is supported by S110 */
- Gap::Role_t role = Gap::PERIPHERAL;
-#else
- Gap::Role_t role = static_cast<Gap::Role_t>(p_ble_evt->evt.gap_evt.params.connected.role);
-#endif
- gap.setConnectionHandle(handle);
- const Gap::ConnectionParams_t *params = reinterpret_cast<Gap::ConnectionParams_t *>(&(p_ble_evt->evt.gap_evt.params.connected.conn_params));
- const ble_gap_addr_t *peer = &p_ble_evt->evt.gap_evt.params.connected.peer_addr;
- const ble_gap_addr_t *own = &p_ble_evt->evt.gap_evt.params.connected.own_addr;
- gap.processConnectionEvent(handle,
- role,
- static_cast<BLEProtocol::AddressType_t>(peer->addr_type), peer->addr,
- static_cast<BLEProtocol::AddressType_t>(own->addr_type), own->addr,
- params);
- break;
- }
-
- case BLE_GAP_EVT_DISCONNECTED: {
- Gap::Handle_t handle = p_ble_evt->evt.gap_evt.conn_handle;
- // Since we are not in a connection and have not started advertising,
- // store bonds
- gap.setConnectionHandle (BLE_CONN_HANDLE_INVALID);
-
- Gap::DisconnectionReason_t reason;
- switch (p_ble_evt->evt.gap_evt.params.disconnected.reason) {
- case BLE_HCI_LOCAL_HOST_TERMINATED_CONNECTION:
- reason = Gap::LOCAL_HOST_TERMINATED_CONNECTION;
- break;
- case BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION:
- reason = Gap::REMOTE_USER_TERMINATED_CONNECTION;
- break;
- case BLE_HCI_CONN_INTERVAL_UNACCEPTABLE:
- reason = Gap::CONN_INTERVAL_UNACCEPTABLE;
- break;
- default:
- /* Please refer to the underlying transport library for an
- * interpretion of this reason's value. */
- reason = static_cast<Gap::DisconnectionReason_t>(p_ble_evt->evt.gap_evt.params.disconnected.reason);
- break;
- }
-
- // Close all pending discoveries for this connection
- nRF5xGattClient& gattClient = ble.getGattClient();
- gattClient.characteristicDescriptorDiscoverer().terminate(handle, BLE_ERROR_INVALID_STATE);
- gattClient.discovery().terminate(handle);
-
- gap.processDisconnectionEvent(handle, reason);
- break;
- }
-
- case BLE_GAP_EVT_PASSKEY_DISPLAY:
- securityManager.processPasskeyDisplayEvent(p_ble_evt->evt.gap_evt.conn_handle, p_ble_evt->evt.gap_evt.params.passkey_display.passkey);
- break;
-
- case BLE_GAP_EVT_TIMEOUT:
- gap.processTimeoutEvent(static_cast<Gap::TimeoutSource_t>(p_ble_evt->evt.gap_evt.params.timeout.src));
- break;
-
- case BLE_GATTC_EVT_TIMEOUT:
- case BLE_GATTS_EVT_TIMEOUT:
- // Disconnect on GATT Server and Client timeout events.
- // ASSERT_STATUS_RET_VOID (sd_ble_gap_disconnect(m_conn_handle,
- // BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION));
- break;
-
- case BLE_GAP_EVT_ADV_REPORT: {
- const ble_gap_evt_adv_report_t *advReport = &p_ble_evt->evt.gap_evt.params.adv_report;
- gap.processAdvertisementReport(advReport->peer_addr.addr,
- advReport->rssi,
- advReport->scan_rsp,
- static_cast<GapAdvertisingParams::AdvertisingType_t>(advReport->type),
- advReport->dlen,
- advReport->data);
- break;
- }
-
- default:
- break;
- }
-
- gattServer.hwCallback(p_ble_evt);
-}
-
-/*! @brief Callback when an error occurs inside the SoftDevice */
-void assert_nrf_callback(uint16_t line_num, const uint8_t *p_file_name)
-{
- ASSERT(false, (void) 0);
-}
-
-/*!
- @brief Handler for general errors above the SoftDevice layer.
- Typically we can' recover from this so we do a reset.
-*/
-void app_error_handler(uint32_t error_code, uint32_t line_num, const uint8_t *p_file_name)
-{
- ASSERT_STATUS_RET_VOID( error_code );
- NVIC_SystemReset();
+/* mbed Microcontroller Library
+ * Copyright (c) 2006-2013 ARM Limited
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ * http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+#include "common/common.h"
+#include "nordic_common.h"
+
+#include "btle.h"
+
+#include "ble_stack_handler_types.h"
+#include "ble_flash.h"
+#include "ble_conn_params.h"
+
+#include "btle_gap.h"
+#include "btle_advertising.h"
+#include "custom/custom_helper.h"
+
+#include "softdevice_handler.h"
+#include "pstorage.h"
+
+#include "ble/GapEvents.h"
+#include "nRF5xGap.h"
+#include "nRF5xGattServer.h"
+#include "nRF5xSecurityManager.h"
+
+#include "device_manager.h"
+
+#include "ble_hci.h"
+#include "btle_discovery.h"
+
+extern "C" void assert_nrf_callback(uint16_t line_num, const uint8_t *p_file_name);
+void app_error_handler(uint32_t error_code, uint32_t line_num, const uint8_t *p_file_name);
+
+static void btle_handler(ble_evt_t *p_ble_evt);
+
+static void sys_evt_dispatch(uint32_t sys_evt)
+{
+ pstorage_sys_event_handler(sys_evt);
+}
+
+/**
+ * This function is called in interrupt context to handle BLE events; i.e. pull
+ * system and user events out of the pending events-queue of the BLE stack. The
+ * BLE stack signals the availability of events by the triggering the SWI2
+ * interrupt, which forwards the handling to this function.
+ *
+ * The event processing loop is implemented in intern_softdevice_events_execute().
+ *
+ * In mbed OS, a callback for intern_softdevice_events_execute() is posted
+ * to the scheduler, which then executes in thread mode. In mbed-classic,
+ * event processing happens right-away in interrupt context (which is more
+ * risk-prone). In either case, the logic of event processing is identical.
+ */
+static uint32_t eventHandler()
+{
+#ifdef YOTTA_CFG_MBED_OS
+ minar::Scheduler::postCallback(intern_softdevice_events_execute);
+#else
+ intern_softdevice_events_execute();
+#endif
+
+ return NRF_SUCCESS;
+}
+
+error_t btle_init(void)
+{
+ nrf_clock_lfclksrc_t clockSource;
+ if (NRF_CLOCK->LFCLKSRC & (CLOCK_LFCLKSRC_SRC_Xtal << CLOCK_LFCLKSRC_SRC_Pos)) {
+ clockSource = NRF_CLOCK_LFCLKSRC_XTAL_20_PPM;
+ } else {
+ clockSource = NRF_CLOCK_LFCLKSRC_RC_250_PPM_4000MS_CALIBRATION;
+ }
+ SOFTDEVICE_HANDLER_INIT(clockSource, eventHandler);
+
+ // Enable BLE stack
+ /**
+ * Using this call, the application can select whether to include the
+ * Service Changed characteristic in the GATT Server. The default in all
+ * previous releases has been to include the Service Changed characteristic,
+ * but this affects how GATT clients behave. Specifically, it requires
+ * clients to subscribe to this attribute and not to cache attribute handles
+ * between connections unless the devices are bonded. If the application
+ * does not need to change the structure of the GATT server attributes at
+ * runtime this adds unnecessary complexity to the interaction with peer
+ * clients. If the SoftDevice is enabled with the Service Changed
+ * Characteristics turned off, then clients are allowed to cache attribute
+ * handles making applications simpler on both sides.
+ */
+ static const bool IS_SRVC_CHANGED_CHARACT_PRESENT = true;
+ ble_enable_params_t enableParams = {
+ .gatts_enable_params = {
+ .service_changed = IS_SRVC_CHANGED_CHARACT_PRESENT
+ }
+ };
+ if (sd_ble_enable(&enableParams) != NRF_SUCCESS) {
+ return ERROR_INVALID_PARAM;
+ }
+
+ ble_gap_addr_t addr;
+ if (sd_ble_gap_address_get(&addr) != NRF_SUCCESS) {
+ return ERROR_INVALID_PARAM;
+ }
+ if (sd_ble_gap_address_set(BLE_GAP_ADDR_CYCLE_MODE_NONE, &addr) != NRF_SUCCESS) {
+ return ERROR_INVALID_PARAM;
+ }
+
+ ASSERT_STATUS( softdevice_ble_evt_handler_set(btle_handler));
+ ASSERT_STATUS( softdevice_sys_evt_handler_set(sys_evt_dispatch));
+
+ btle_gap_init();
+
+ return ERROR_NONE;
+}
+
+static void btle_handler(ble_evt_t *p_ble_evt)
+{
+ /* Library service handlers */
+#if SDK_CONN_PARAMS_MODULE_ENABLE
+ ble_conn_params_on_ble_evt(p_ble_evt);
+#endif
+
+ dm_ble_evt_handler(p_ble_evt);
+
+#if !defined(TARGET_MCU_NRF51_16K_S110) && !defined(TARGET_MCU_NRF51_32K_S110)
+ bleGattcEventHandler(p_ble_evt);
+#endif
+
+ /* Custom event handler */
+ switch (p_ble_evt->header.evt_id) {
+ case BLE_GAP_EVT_CONNECTED: {
+ Gap::Handle_t handle = p_ble_evt->evt.gap_evt.conn_handle;
+#if defined(TARGET_MCU_NRF51_16K_S110) || defined(TARGET_MCU_NRF51_32K_S110)
+ /* Only peripheral role is supported by S110 */
+ Gap::Role_t role = Gap::PERIPHERAL;
+#else
+ Gap::Role_t role = static_cast<Gap::Role_t>(p_ble_evt->evt.gap_evt.params.connected.role);
+#endif
+ nRF5xGap::getInstance().setConnectionHandle(handle);
+ const Gap::ConnectionParams_t *params = reinterpret_cast<Gap::ConnectionParams_t *>(&(p_ble_evt->evt.gap_evt.params.connected.conn_params));
+ const ble_gap_addr_t *peer = &p_ble_evt->evt.gap_evt.params.connected.peer_addr;
+ const ble_gap_addr_t *own = &p_ble_evt->evt.gap_evt.params.connected.own_addr;
+ nRF5xGap::getInstance().processConnectionEvent(handle,
+ role,
+ static_cast<Gap::AddressType_t>(peer->addr_type), peer->addr,
+ static_cast<Gap::AddressType_t>(own->addr_type), own->addr,
+ params);
+ break;
+ }
+
+ case BLE_GAP_EVT_DISCONNECTED: {
+ Gap::Handle_t handle = p_ble_evt->evt.gap_evt.conn_handle;
+ // Since we are not in a connection and have not started advertising,
+ // store bonds
+ nRF5xGap::getInstance().setConnectionHandle (BLE_CONN_HANDLE_INVALID);
+
+ Gap::DisconnectionReason_t reason;
+ switch (p_ble_evt->evt.gap_evt.params.disconnected.reason) {
+ case BLE_HCI_LOCAL_HOST_TERMINATED_CONNECTION:
+ reason = Gap::LOCAL_HOST_TERMINATED_CONNECTION;
+ break;
+ case BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION:
+ reason = Gap::REMOTE_USER_TERMINATED_CONNECTION;
+ break;
+ case BLE_HCI_CONN_INTERVAL_UNACCEPTABLE:
+ reason = Gap::CONN_INTERVAL_UNACCEPTABLE;
+ break;
+ default:
+ /* Please refer to the underlying transport library for an
+ * interpretion of this reason's value. */
+ reason = static_cast<Gap::DisconnectionReason_t>(p_ble_evt->evt.gap_evt.params.disconnected.reason);
+ break;
+ }
+ nRF5xGap::getInstance().processDisconnectionEvent(handle, reason);
+ break;
+ }
+
+ case BLE_GAP_EVT_PASSKEY_DISPLAY:
+ nRF5xSecurityManager::getInstance().processPasskeyDisplayEvent(p_ble_evt->evt.gap_evt.conn_handle, p_ble_evt->evt.gap_evt.params.passkey_display.passkey);
+ break;
+
+ case BLE_GAP_EVT_TIMEOUT:
+ nRF5xGap::getInstance().processTimeoutEvent(static_cast<Gap::TimeoutSource_t>(p_ble_evt->evt.gap_evt.params.timeout.src));
+ break;
+
+ case BLE_GATTC_EVT_TIMEOUT:
+ case BLE_GATTS_EVT_TIMEOUT:
+ // Disconnect on GATT Server and Client timeout events.
+ // ASSERT_STATUS_RET_VOID (sd_ble_gap_disconnect(m_conn_handle,
+ // BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION));
+ break;
+
+ case BLE_GAP_EVT_ADV_REPORT: {
+ const ble_gap_evt_adv_report_t *advReport = &p_ble_evt->evt.gap_evt.params.adv_report;
+ nRF5xGap::getInstance().processAdvertisementReport(advReport->peer_addr.addr,
+ advReport->rssi,
+ advReport->scan_rsp,
+ static_cast<GapAdvertisingParams::AdvertisingType_t>(advReport->type),
+ advReport->dlen,
+ advReport->data);
+ break;
+ }
+
+ default:
+ break;
+ }
+
+ nRF5xGattServer::getInstance().hwCallback(p_ble_evt);
+}
+
+/*! @brief Callback when an error occurs inside the SoftDevice */
+void assert_nrf_callback(uint16_t line_num, const uint8_t *p_file_name)
+{
+ ASSERT(false, (void) 0);
+}
+
+/*!
+ @brief Handler for general errors above the SoftDevice layer.
+ Typically we can' recover from this so we do a reset.
+*/
+void app_error_handler(uint32_t error_code, uint32_t line_num, const uint8_t *p_file_name)
+{
+ ASSERT_STATUS_RET_VOID( error_code );
+ NVIC_SystemReset();
}
\ No newline at end of file