No changes
Fork of nRF51822 by
source/btle/btle.cpp@591:266079a50c20, 2016-01-11 (annotated)
- Committer:
- vcoubard
- Date:
- Mon Jan 11 10:19:32 2016 +0000
- Revision:
- 591:266079a50c20
- Parent:
- 590:3bdd5346ded1
- Child:
- 592:f9574772b816
Synchronized with git rev 4092d569
Author: Vincent Coubard
version v2.2.10
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
vcoubard | 541:884f95bf5351 | 1 | /* mbed Microcontroller Library |
vcoubard | 541:884f95bf5351 | 2 | * Copyright (c) 2006-2013 ARM Limited |
vcoubard | 541:884f95bf5351 | 3 | * |
vcoubard | 541:884f95bf5351 | 4 | * Licensed under the Apache License, Version 2.0 (the "License"); |
vcoubard | 541:884f95bf5351 | 5 | * you may not use this file except in compliance with the License. |
vcoubard | 541:884f95bf5351 | 6 | * You may obtain a copy of the License at |
vcoubard | 541:884f95bf5351 | 7 | * |
vcoubard | 541:884f95bf5351 | 8 | * http://www.apache.org/licenses/LICENSE-2.0 |
vcoubard | 541:884f95bf5351 | 9 | * |
vcoubard | 541:884f95bf5351 | 10 | * Unless required by applicable law or agreed to in writing, software |
vcoubard | 541:884f95bf5351 | 11 | * distributed under the License is distributed on an "AS IS" BASIS, |
vcoubard | 541:884f95bf5351 | 12 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
vcoubard | 541:884f95bf5351 | 13 | * See the License for the specific language governing permissions and |
vcoubard | 541:884f95bf5351 | 14 | * limitations under the License. |
vcoubard | 541:884f95bf5351 | 15 | */ |
vcoubard | 541:884f95bf5351 | 16 | |
vcoubard | 541:884f95bf5351 | 17 | #include "common/common.h" |
vcoubard | 541:884f95bf5351 | 18 | #include "nordic_common.h" |
vcoubard | 541:884f95bf5351 | 19 | |
vcoubard | 541:884f95bf5351 | 20 | #include "btle.h" |
vcoubard | 541:884f95bf5351 | 21 | |
vcoubard | 541:884f95bf5351 | 22 | #include "ble_flash.h" |
vcoubard | 541:884f95bf5351 | 23 | #include "ble_conn_params.h" |
vcoubard | 541:884f95bf5351 | 24 | |
vcoubard | 541:884f95bf5351 | 25 | #include "btle_gap.h" |
vcoubard | 541:884f95bf5351 | 26 | #include "btle_advertising.h" |
vcoubard | 541:884f95bf5351 | 27 | #include "custom/custom_helper.h" |
vcoubard | 541:884f95bf5351 | 28 | |
vcoubard | 541:884f95bf5351 | 29 | #include "ble/GapEvents.h" |
vcoubard | 575:7023a8204a1b | 30 | #include "nRF5xn.h" |
vcoubard | 541:884f95bf5351 | 31 | |
vcoubard | 549:3f782c64d014 | 32 | extern "C" { |
vcoubard | 549:3f782c64d014 | 33 | #include "pstorage.h" |
vcoubard | 541:884f95bf5351 | 34 | #include "device_manager.h" |
vcoubard | 549:3f782c64d014 | 35 | #include "softdevice_handler.h" |
vcoubard | 549:3f782c64d014 | 36 | #include "ble_stack_handler_types.h" |
vcoubard | 549:3f782c64d014 | 37 | } |
vcoubard | 541:884f95bf5351 | 38 | |
vcoubard | 541:884f95bf5351 | 39 | #include "ble_hci.h" |
vcoubard | 541:884f95bf5351 | 40 | #include "btle_discovery.h" |
vcoubard | 541:884f95bf5351 | 41 | |
vcoubard | 541:884f95bf5351 | 42 | extern "C" void assert_nrf_callback(uint16_t line_num, const uint8_t *p_file_name); |
vcoubard | 541:884f95bf5351 | 43 | void app_error_handler(uint32_t error_code, uint32_t line_num, const uint8_t *p_file_name); |
vcoubard | 541:884f95bf5351 | 44 | |
vcoubard | 541:884f95bf5351 | 45 | static void btle_handler(ble_evt_t *p_ble_evt); |
vcoubard | 541:884f95bf5351 | 46 | |
vcoubard | 541:884f95bf5351 | 47 | static void sys_evt_dispatch(uint32_t sys_evt) |
vcoubard | 541:884f95bf5351 | 48 | { |
vcoubard | 541:884f95bf5351 | 49 | pstorage_sys_event_handler(sys_evt); |
vcoubard | 541:884f95bf5351 | 50 | } |
vcoubard | 541:884f95bf5351 | 51 | |
vcoubard | 541:884f95bf5351 | 52 | /** |
vcoubard | 541:884f95bf5351 | 53 | * This function is called in interrupt context to handle BLE events; i.e. pull |
vcoubard | 541:884f95bf5351 | 54 | * system and user events out of the pending events-queue of the BLE stack. The |
vcoubard | 541:884f95bf5351 | 55 | * BLE stack signals the availability of events by the triggering the SWI2 |
vcoubard | 541:884f95bf5351 | 56 | * interrupt, which forwards the handling to this function. |
vcoubard | 541:884f95bf5351 | 57 | * |
vcoubard | 541:884f95bf5351 | 58 | * The event processing loop is implemented in intern_softdevice_events_execute(). |
vcoubard | 541:884f95bf5351 | 59 | * |
vcoubard | 541:884f95bf5351 | 60 | * In mbed OS, a callback for intern_softdevice_events_execute() is posted |
vcoubard | 541:884f95bf5351 | 61 | * to the scheduler, which then executes in thread mode. In mbed-classic, |
vcoubard | 541:884f95bf5351 | 62 | * event processing happens right-away in interrupt context (which is more |
vcoubard | 541:884f95bf5351 | 63 | * risk-prone). In either case, the logic of event processing is identical. |
vcoubard | 541:884f95bf5351 | 64 | */ |
vcoubard | 541:884f95bf5351 | 65 | static uint32_t eventHandler() |
vcoubard | 541:884f95bf5351 | 66 | { |
vcoubard | 541:884f95bf5351 | 67 | #ifdef YOTTA_CFG_MBED_OS |
vcoubard | 541:884f95bf5351 | 68 | minar::Scheduler::postCallback(intern_softdevice_events_execute); |
vcoubard | 541:884f95bf5351 | 69 | #else |
vcoubard | 541:884f95bf5351 | 70 | intern_softdevice_events_execute(); |
vcoubard | 541:884f95bf5351 | 71 | #endif |
vcoubard | 541:884f95bf5351 | 72 | |
vcoubard | 541:884f95bf5351 | 73 | return NRF_SUCCESS; |
vcoubard | 541:884f95bf5351 | 74 | } |
vcoubard | 541:884f95bf5351 | 75 | |
vcoubard | 541:884f95bf5351 | 76 | error_t btle_init(void) |
vcoubard | 541:884f95bf5351 | 77 | { |
vcoubard | 541:884f95bf5351 | 78 | nrf_clock_lfclksrc_t clockSource; |
vcoubard | 541:884f95bf5351 | 79 | if (NRF_CLOCK->LFCLKSRC & (CLOCK_LFCLKSRC_SRC_Xtal << CLOCK_LFCLKSRC_SRC_Pos)) { |
vcoubard | 541:884f95bf5351 | 80 | clockSource = NRF_CLOCK_LFCLKSRC_XTAL_20_PPM; |
vcoubard | 541:884f95bf5351 | 81 | } else { |
vcoubard | 541:884f95bf5351 | 82 | clockSource = NRF_CLOCK_LFCLKSRC_RC_250_PPM_4000MS_CALIBRATION; |
vcoubard | 541:884f95bf5351 | 83 | } |
vcoubard | 541:884f95bf5351 | 84 | SOFTDEVICE_HANDLER_INIT(clockSource, eventHandler); |
vcoubard | 541:884f95bf5351 | 85 | |
vcoubard | 541:884f95bf5351 | 86 | // Enable BLE stack |
vcoubard | 541:884f95bf5351 | 87 | /** |
vcoubard | 541:884f95bf5351 | 88 | * Using this call, the application can select whether to include the |
vcoubard | 541:884f95bf5351 | 89 | * Service Changed characteristic in the GATT Server. The default in all |
vcoubard | 541:884f95bf5351 | 90 | * previous releases has been to include the Service Changed characteristic, |
vcoubard | 541:884f95bf5351 | 91 | * but this affects how GATT clients behave. Specifically, it requires |
vcoubard | 541:884f95bf5351 | 92 | * clients to subscribe to this attribute and not to cache attribute handles |
vcoubard | 541:884f95bf5351 | 93 | * between connections unless the devices are bonded. If the application |
vcoubard | 541:884f95bf5351 | 94 | * does not need to change the structure of the GATT server attributes at |
vcoubard | 541:884f95bf5351 | 95 | * runtime this adds unnecessary complexity to the interaction with peer |
vcoubard | 541:884f95bf5351 | 96 | * clients. If the SoftDevice is enabled with the Service Changed |
vcoubard | 541:884f95bf5351 | 97 | * Characteristics turned off, then clients are allowed to cache attribute |
vcoubard | 541:884f95bf5351 | 98 | * handles making applications simpler on both sides. |
vcoubard | 541:884f95bf5351 | 99 | */ |
vcoubard | 541:884f95bf5351 | 100 | static const bool IS_SRVC_CHANGED_CHARACT_PRESENT = true; |
vcoubard | 541:884f95bf5351 | 101 | ble_enable_params_t enableParams = { |
vcoubard | 541:884f95bf5351 | 102 | .gatts_enable_params = { |
vcoubard | 541:884f95bf5351 | 103 | .service_changed = IS_SRVC_CHANGED_CHARACT_PRESENT |
vcoubard | 541:884f95bf5351 | 104 | } |
vcoubard | 541:884f95bf5351 | 105 | }; |
vcoubard | 541:884f95bf5351 | 106 | if (sd_ble_enable(&enableParams) != NRF_SUCCESS) { |
vcoubard | 541:884f95bf5351 | 107 | return ERROR_INVALID_PARAM; |
vcoubard | 541:884f95bf5351 | 108 | } |
vcoubard | 541:884f95bf5351 | 109 | |
vcoubard | 541:884f95bf5351 | 110 | ble_gap_addr_t addr; |
vcoubard | 541:884f95bf5351 | 111 | if (sd_ble_gap_address_get(&addr) != NRF_SUCCESS) { |
vcoubard | 541:884f95bf5351 | 112 | return ERROR_INVALID_PARAM; |
vcoubard | 541:884f95bf5351 | 113 | } |
vcoubard | 541:884f95bf5351 | 114 | if (sd_ble_gap_address_set(BLE_GAP_ADDR_CYCLE_MODE_NONE, &addr) != NRF_SUCCESS) { |
vcoubard | 541:884f95bf5351 | 115 | return ERROR_INVALID_PARAM; |
vcoubard | 541:884f95bf5351 | 116 | } |
vcoubard | 541:884f95bf5351 | 117 | |
vcoubard | 541:884f95bf5351 | 118 | ASSERT_STATUS( softdevice_ble_evt_handler_set(btle_handler)); |
vcoubard | 541:884f95bf5351 | 119 | ASSERT_STATUS( softdevice_sys_evt_handler_set(sys_evt_dispatch)); |
vcoubard | 541:884f95bf5351 | 120 | |
vcoubard | 586:533fd7fdb0fe | 121 | return btle_gap_init(); |
vcoubard | 541:884f95bf5351 | 122 | } |
vcoubard | 541:884f95bf5351 | 123 | |
vcoubard | 541:884f95bf5351 | 124 | static void btle_handler(ble_evt_t *p_ble_evt) |
vcoubard | 541:884f95bf5351 | 125 | { |
vcoubard | 541:884f95bf5351 | 126 | /* Library service handlers */ |
vcoubard | 541:884f95bf5351 | 127 | #if SDK_CONN_PARAMS_MODULE_ENABLE |
vcoubard | 541:884f95bf5351 | 128 | ble_conn_params_on_ble_evt(p_ble_evt); |
vcoubard | 541:884f95bf5351 | 129 | #endif |
vcoubard | 541:884f95bf5351 | 130 | |
vcoubard | 541:884f95bf5351 | 131 | dm_ble_evt_handler(p_ble_evt); |
vcoubard | 541:884f95bf5351 | 132 | |
vcoubard | 541:884f95bf5351 | 133 | #if !defined(TARGET_MCU_NRF51_16K_S110) && !defined(TARGET_MCU_NRF51_32K_S110) |
vcoubard | 541:884f95bf5351 | 134 | bleGattcEventHandler(p_ble_evt); |
vcoubard | 541:884f95bf5351 | 135 | #endif |
vcoubard | 541:884f95bf5351 | 136 | |
vcoubard | 575:7023a8204a1b | 137 | nRF5xn &ble = nRF5xn::Instance(BLE::DEFAULT_INSTANCE); |
vcoubard | 575:7023a8204a1b | 138 | nRF5xGap &gap = (nRF5xGap &) ble.getGap(); |
vcoubard | 575:7023a8204a1b | 139 | nRF5xGattServer &gattServer = (nRF5xGattServer &) ble.getGattServer(); |
vcoubard | 575:7023a8204a1b | 140 | nRF5xSecurityManager &securityManager = (nRF5xSecurityManager &) ble.getSecurityManager(); |
vcoubard | 575:7023a8204a1b | 141 | |
vcoubard | 541:884f95bf5351 | 142 | /* Custom event handler */ |
vcoubard | 541:884f95bf5351 | 143 | switch (p_ble_evt->header.evt_id) { |
vcoubard | 541:884f95bf5351 | 144 | case BLE_GAP_EVT_CONNECTED: { |
vcoubard | 541:884f95bf5351 | 145 | Gap::Handle_t handle = p_ble_evt->evt.gap_evt.conn_handle; |
vcoubard | 541:884f95bf5351 | 146 | #if defined(TARGET_MCU_NRF51_16K_S110) || defined(TARGET_MCU_NRF51_32K_S110) |
vcoubard | 541:884f95bf5351 | 147 | /* Only peripheral role is supported by S110 */ |
vcoubard | 541:884f95bf5351 | 148 | Gap::Role_t role = Gap::PERIPHERAL; |
vcoubard | 541:884f95bf5351 | 149 | #else |
vcoubard | 541:884f95bf5351 | 150 | Gap::Role_t role = static_cast<Gap::Role_t>(p_ble_evt->evt.gap_evt.params.connected.role); |
vcoubard | 541:884f95bf5351 | 151 | #endif |
vcoubard | 575:7023a8204a1b | 152 | gap.setConnectionHandle(handle); |
vcoubard | 541:884f95bf5351 | 153 | const Gap::ConnectionParams_t *params = reinterpret_cast<Gap::ConnectionParams_t *>(&(p_ble_evt->evt.gap_evt.params.connected.conn_params)); |
vcoubard | 541:884f95bf5351 | 154 | const ble_gap_addr_t *peer = &p_ble_evt->evt.gap_evt.params.connected.peer_addr; |
vcoubard | 541:884f95bf5351 | 155 | const ble_gap_addr_t *own = &p_ble_evt->evt.gap_evt.params.connected.own_addr; |
vcoubard | 575:7023a8204a1b | 156 | gap.processConnectionEvent(handle, |
vcoubard | 541:884f95bf5351 | 157 | role, |
vcoubard | 577:d38f01a3e701 | 158 | static_cast<BLEProtocol::AddressType_t>(peer->addr_type), peer->addr, |
vcoubard | 577:d38f01a3e701 | 159 | static_cast<BLEProtocol::AddressType_t>(own->addr_type), own->addr, |
vcoubard | 541:884f95bf5351 | 160 | params); |
vcoubard | 541:884f95bf5351 | 161 | break; |
vcoubard | 541:884f95bf5351 | 162 | } |
vcoubard | 541:884f95bf5351 | 163 | |
vcoubard | 541:884f95bf5351 | 164 | case BLE_GAP_EVT_DISCONNECTED: { |
vcoubard | 541:884f95bf5351 | 165 | Gap::Handle_t handle = p_ble_evt->evt.gap_evt.conn_handle; |
vcoubard | 541:884f95bf5351 | 166 | // Since we are not in a connection and have not started advertising, |
vcoubard | 541:884f95bf5351 | 167 | // store bonds |
vcoubard | 575:7023a8204a1b | 168 | gap.setConnectionHandle (BLE_CONN_HANDLE_INVALID); |
vcoubard | 541:884f95bf5351 | 169 | |
vcoubard | 541:884f95bf5351 | 170 | Gap::DisconnectionReason_t reason; |
vcoubard | 541:884f95bf5351 | 171 | switch (p_ble_evt->evt.gap_evt.params.disconnected.reason) { |
vcoubard | 541:884f95bf5351 | 172 | case BLE_HCI_LOCAL_HOST_TERMINATED_CONNECTION: |
vcoubard | 541:884f95bf5351 | 173 | reason = Gap::LOCAL_HOST_TERMINATED_CONNECTION; |
vcoubard | 541:884f95bf5351 | 174 | break; |
vcoubard | 541:884f95bf5351 | 175 | case BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION: |
vcoubard | 541:884f95bf5351 | 176 | reason = Gap::REMOTE_USER_TERMINATED_CONNECTION; |
vcoubard | 541:884f95bf5351 | 177 | break; |
vcoubard | 541:884f95bf5351 | 178 | case BLE_HCI_CONN_INTERVAL_UNACCEPTABLE: |
vcoubard | 541:884f95bf5351 | 179 | reason = Gap::CONN_INTERVAL_UNACCEPTABLE; |
vcoubard | 541:884f95bf5351 | 180 | break; |
vcoubard | 541:884f95bf5351 | 181 | default: |
vcoubard | 541:884f95bf5351 | 182 | /* Please refer to the underlying transport library for an |
vcoubard | 541:884f95bf5351 | 183 | * interpretion of this reason's value. */ |
vcoubard | 541:884f95bf5351 | 184 | reason = static_cast<Gap::DisconnectionReason_t>(p_ble_evt->evt.gap_evt.params.disconnected.reason); |
vcoubard | 541:884f95bf5351 | 185 | break; |
vcoubard | 541:884f95bf5351 | 186 | } |
vcoubard | 575:7023a8204a1b | 187 | gap.processDisconnectionEvent(handle, reason); |
vcoubard | 541:884f95bf5351 | 188 | break; |
vcoubard | 541:884f95bf5351 | 189 | } |
vcoubard | 541:884f95bf5351 | 190 | |
vcoubard | 541:884f95bf5351 | 191 | case BLE_GAP_EVT_PASSKEY_DISPLAY: |
vcoubard | 575:7023a8204a1b | 192 | securityManager.processPasskeyDisplayEvent(p_ble_evt->evt.gap_evt.conn_handle, p_ble_evt->evt.gap_evt.params.passkey_display.passkey); |
vcoubard | 541:884f95bf5351 | 193 | break; |
vcoubard | 541:884f95bf5351 | 194 | |
vcoubard | 541:884f95bf5351 | 195 | case BLE_GAP_EVT_TIMEOUT: |
vcoubard | 575:7023a8204a1b | 196 | gap.processTimeoutEvent(static_cast<Gap::TimeoutSource_t>(p_ble_evt->evt.gap_evt.params.timeout.src)); |
vcoubard | 541:884f95bf5351 | 197 | break; |
vcoubard | 541:884f95bf5351 | 198 | |
vcoubard | 541:884f95bf5351 | 199 | case BLE_GATTC_EVT_TIMEOUT: |
vcoubard | 541:884f95bf5351 | 200 | case BLE_GATTS_EVT_TIMEOUT: |
vcoubard | 541:884f95bf5351 | 201 | // Disconnect on GATT Server and Client timeout events. |
vcoubard | 541:884f95bf5351 | 202 | // ASSERT_STATUS_RET_VOID (sd_ble_gap_disconnect(m_conn_handle, |
vcoubard | 541:884f95bf5351 | 203 | // BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION)); |
vcoubard | 541:884f95bf5351 | 204 | break; |
vcoubard | 541:884f95bf5351 | 205 | |
vcoubard | 541:884f95bf5351 | 206 | case BLE_GAP_EVT_ADV_REPORT: { |
vcoubard | 541:884f95bf5351 | 207 | const ble_gap_evt_adv_report_t *advReport = &p_ble_evt->evt.gap_evt.params.adv_report; |
vcoubard | 575:7023a8204a1b | 208 | gap.processAdvertisementReport(advReport->peer_addr.addr, |
vcoubard | 575:7023a8204a1b | 209 | advReport->rssi, |
vcoubard | 575:7023a8204a1b | 210 | advReport->scan_rsp, |
vcoubard | 575:7023a8204a1b | 211 | static_cast<GapAdvertisingParams::AdvertisingType_t>(advReport->type), |
vcoubard | 575:7023a8204a1b | 212 | advReport->dlen, |
vcoubard | 575:7023a8204a1b | 213 | advReport->data); |
vcoubard | 541:884f95bf5351 | 214 | break; |
vcoubard | 541:884f95bf5351 | 215 | } |
vcoubard | 541:884f95bf5351 | 216 | |
vcoubard | 541:884f95bf5351 | 217 | default: |
vcoubard | 541:884f95bf5351 | 218 | break; |
vcoubard | 541:884f95bf5351 | 219 | } |
vcoubard | 541:884f95bf5351 | 220 | |
vcoubard | 575:7023a8204a1b | 221 | gattServer.hwCallback(p_ble_evt); |
vcoubard | 541:884f95bf5351 | 222 | } |
vcoubard | 541:884f95bf5351 | 223 | |
vcoubard | 541:884f95bf5351 | 224 | /*! @brief Callback when an error occurs inside the SoftDevice */ |
vcoubard | 541:884f95bf5351 | 225 | void assert_nrf_callback(uint16_t line_num, const uint8_t *p_file_name) |
vcoubard | 541:884f95bf5351 | 226 | { |
vcoubard | 541:884f95bf5351 | 227 | ASSERT(false, (void) 0); |
vcoubard | 541:884f95bf5351 | 228 | } |
vcoubard | 541:884f95bf5351 | 229 | |
vcoubard | 541:884f95bf5351 | 230 | /*! |
vcoubard | 541:884f95bf5351 | 231 | @brief Handler for general errors above the SoftDevice layer. |
vcoubard | 541:884f95bf5351 | 232 | Typically we can' recover from this so we do a reset. |
vcoubard | 541:884f95bf5351 | 233 | */ |
vcoubard | 541:884f95bf5351 | 234 | void app_error_handler(uint32_t error_code, uint32_t line_num, const uint8_t *p_file_name) |
vcoubard | 541:884f95bf5351 | 235 | { |
vcoubard | 541:884f95bf5351 | 236 | ASSERT_STATUS_RET_VOID( error_code ); |
vcoubard | 541:884f95bf5351 | 237 | NVIC_SystemReset(); |
rgrover1 | 77:9886b2865631 | 238 | } |