mbed official / mbed-dev

mbed library sources. Supersedes mbed-src.

Dependents:   Nucleo_Hello_Encoder BLE_iBeaconScan AM1805_DEMO DISCO-F429ZI_ExportTemplate1 ... more

targets/TARGET_NORDIC/TARGET_NRF5/TARGET_SDK11/softdevice/common/softdevice_handler/softdevice_handler.c@174:b96e65c34a4d, 2017-10-02 (annotated)

Committer:
AnnaBridge
Date:
Mon Oct 02 15:33:19 2017 +0100
Revision:
174:b96e65c34a4d
Parent:
165:e614a9f1c9e2 
This updates the lib to the mbed lib v 152

Who changed what in which revision?

UserRevisionLine numberNew contents of line
<> 144:ef7eb2e8f9f7 1 /*
<> 144:ef7eb2e8f9f7 2 * Copyright (c) 2012 Nordic Semiconductor ASA
<> 144:ef7eb2e8f9f7 3 * All rights reserved.
<> 144:ef7eb2e8f9f7 4 *
<> 144:ef7eb2e8f9f7 5 * Redistribution and use in source and binary forms, with or without modification,
<> 144:ef7eb2e8f9f7 6 * are permitted provided that the following conditions are met:
<> 144:ef7eb2e8f9f7 7 *
<> 144:ef7eb2e8f9f7 8 * 1. Redistributions of source code must retain the above copyright notice, this list
<> 144:ef7eb2e8f9f7 9 * of conditions and the following disclaimer.
<> 144:ef7eb2e8f9f7 10 *
<> 144:ef7eb2e8f9f7 11 * 2. Redistributions in binary form, except as embedded into a Nordic Semiconductor ASA
<> 144:ef7eb2e8f9f7 12 * integrated circuit in a product or a software update for such product, must reproduce
<> 144:ef7eb2e8f9f7 13 * the above copyright notice, this list of conditions and the following disclaimer in
<> 144:ef7eb2e8f9f7 14 * the documentation and/or other materials provided with the distribution.
<> 144:ef7eb2e8f9f7 15 *
<> 144:ef7eb2e8f9f7 16 * 3. Neither the name of Nordic Semiconductor ASA nor the names of its contributors may be
<> 144:ef7eb2e8f9f7 17 * used to endorse or promote products derived from this software without specific prior
<> 144:ef7eb2e8f9f7 18 * written permission.
<> 144:ef7eb2e8f9f7 19 *
<> 144:ef7eb2e8f9f7 20 * 4. This software, with or without modification, must only be used with a
<> 144:ef7eb2e8f9f7 21 * Nordic Semiconductor ASA integrated circuit.
<> 144:ef7eb2e8f9f7 22 *
<> 144:ef7eb2e8f9f7 23 * 5. Any software provided in binary or object form under this license must not be reverse
<> 144:ef7eb2e8f9f7 24 * engineered, decompiled, modified and/or disassembled.
<> 144:ef7eb2e8f9f7 25 *
<> 144:ef7eb2e8f9f7 26 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
<> 144:ef7eb2e8f9f7 27 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
<> 144:ef7eb2e8f9f7 28 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
<> 144:ef7eb2e8f9f7 29 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR
<> 144:ef7eb2e8f9f7 30 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
<> 144:ef7eb2e8f9f7 31 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
<> 144:ef7eb2e8f9f7 32 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
<> 144:ef7eb2e8f9f7 33 * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
<> 144:ef7eb2e8f9f7 34 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
<> 144:ef7eb2e8f9f7 35 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
<> 144:ef7eb2e8f9f7 36 *
<> 144:ef7eb2e8f9f7 37 */
<> 144:ef7eb2e8f9f7 38
<> 144:ef7eb2e8f9f7 39
<> 144:ef7eb2e8f9f7 40 #include "softdevice_handler.h"
<> 144:ef7eb2e8f9f7 41 #include <stdlib.h>
<> 144:ef7eb2e8f9f7 42 #include <stdint.h>
<> 144:ef7eb2e8f9f7 43 #include <stdio.h>
<> 144:ef7eb2e8f9f7 44 #include <string.h>
<> 144:ef7eb2e8f9f7 45 #include "nordic_common.h"
<> 144:ef7eb2e8f9f7 46 #include "app_error.h"
<> 144:ef7eb2e8f9f7 47 #include "nrf_assert.h"
<> 144:ef7eb2e8f9f7 48 #include "nrf_nvic.h"
<> 144:ef7eb2e8f9f7 49 #include "nrf.h"
<> 144:ef7eb2e8f9f7 50 #include "nrf_log.h"
<> 144:ef7eb2e8f9f7 51 #include "sdk_common.h"
<> 144:ef7eb2e8f9f7 52 #include "nrf_drv_config.h"
<> 144:ef7eb2e8f9f7 53 #if CLOCK_ENABLED
<> 144:ef7eb2e8f9f7 54 #include "nrf_drv_clock.h"
<> 144:ef7eb2e8f9f7 55 #endif
<> 144:ef7eb2e8f9f7 56
<> 144:ef7eb2e8f9f7 57 #if defined(ANT_STACK_SUPPORT_REQD) && defined(BLE_STACK_SUPPORT_REQD)
<> 144:ef7eb2e8f9f7 58 #include "ant_interface.h"
<> 144:ef7eb2e8f9f7 59 #elif defined(ANT_STACK_SUPPORT_REQD)
<> 144:ef7eb2e8f9f7 60 #include "ant_interface.h"
<> 144:ef7eb2e8f9f7 61 #elif defined(BLE_STACK_SUPPORT_REQD)
<> 144:ef7eb2e8f9f7 62 #include "nrf_ble.h"
<> 144:ef7eb2e8f9f7 63 #endif
<> 144:ef7eb2e8f9f7 64
<> 144:ef7eb2e8f9f7 65
<> 144:ef7eb2e8f9f7 66 #if defined(NRF_LOG_USES_RTT) && NRF_LOG_USES_RTT == 1
<> 144:ef7eb2e8f9f7 67 #define SD_HANDLER_LOG(...) NRF_LOG_PRINTF(__VA_ARGS__)
<> 144:ef7eb2e8f9f7 68 #else
<> 144:ef7eb2e8f9f7 69 #define SD_HANDLER_LOG(...)
<> 144:ef7eb2e8f9f7 70 #endif
<> 144:ef7eb2e8f9f7 71
<> 144:ef7eb2e8f9f7 72 #if defined(NRF_LOG_USES_RTT) && NRF_LOG_USES_RTT == 1
<> 144:ef7eb2e8f9f7 73 #define SD_HANDLER_LOG_INIT() NRF_LOG_INIT()
<> 144:ef7eb2e8f9f7 74 #else
<> 144:ef7eb2e8f9f7 75 #define SD_HANDLER_LOG_INIT()
<> 144:ef7eb2e8f9f7 76 #endif
<> 144:ef7eb2e8f9f7 77
<> 144:ef7eb2e8f9f7 78
<> 144:ef7eb2e8f9f7 79
<> 144:ef7eb2e8f9f7 80 #define RAM_START_ADDRESS 0x20000000
<> 144:ef7eb2e8f9f7 81 #define SOFTDEVICE_EVT_IRQ SD_EVT_IRQn /**< SoftDevice Event IRQ number. Used for both protocol events and SoC events. */
<> 144:ef7eb2e8f9f7 82 #define SOFTDEVICE_EVT_IRQHandler SD_EVT_IRQHandler
<> 144:ef7eb2e8f9f7 83 #define RAM_TOTAL_SIZE ((NRF_FICR->INFO.RAM)*1024)
<> 144:ef7eb2e8f9f7 84 #define RAM_END_ADDRESS (RAM_START_ADDRESS + RAM_TOTAL_SIZE)
<> 144:ef7eb2e8f9f7 85
<> 144:ef7eb2e8f9f7 86
<> 144:ef7eb2e8f9f7 87 #define SOFTDEVICE_VS_UUID_COUNT 0
<> 144:ef7eb2e8f9f7 88 #define SOFTDEVICE_GATTS_ATTR_TAB_SIZE BLE_GATTS_ATTR_TAB_SIZE_DEFAULT
<> 144:ef7eb2e8f9f7 89 #define SOFTDEVICE_GATTS_SRV_CHANGED 0
<> 144:ef7eb2e8f9f7 90 #define SOFTDEVICE_PERIPH_CONN_COUNT 1
<> 144:ef7eb2e8f9f7 91 #define SOFTDEVICE_CENTRAL_CONN_COUNT 4
<> 144:ef7eb2e8f9f7 92 #define SOFTDEVICE_CENTRAL_SEC_COUNT 1
<> 144:ef7eb2e8f9f7 93
<> 144:ef7eb2e8f9f7 94 /* Global nvic state instance, required by nrf_nvic.h */
<> 144:ef7eb2e8f9f7 95 nrf_nvic_state_t nrf_nvic_state;
<> 144:ef7eb2e8f9f7 96
<> 144:ef7eb2e8f9f7 97 static softdevice_evt_schedule_func_t m_evt_schedule_func; /**< Pointer to function for propagating SoftDevice events to the scheduler. */
<> 144:ef7eb2e8f9f7 98
<> 144:ef7eb2e8f9f7 99 static volatile bool m_softdevice_enabled = false; /**< Variable to indicate whether the SoftDevice is enabled. */
<> 144:ef7eb2e8f9f7 100
<> 144:ef7eb2e8f9f7 101 #ifdef BLE_STACK_SUPPORT_REQD
<> 144:ef7eb2e8f9f7 102 // The following three definitions is needed only if BLE events are needed to be pulled from the stack.
<> 144:ef7eb2e8f9f7 103 static uint8_t * mp_ble_evt_buffer; /**< Buffer for receiving BLE events from the SoftDevice. */
<> 144:ef7eb2e8f9f7 104 static uint16_t m_ble_evt_buffer_size; /**< Size of BLE event buffer. */
<> 144:ef7eb2e8f9f7 105 static ble_evt_handler_t m_ble_evt_handler; /**< Application event handler for handling BLE events. */
<> 144:ef7eb2e8f9f7 106 #endif
<> 144:ef7eb2e8f9f7 107
<> 144:ef7eb2e8f9f7 108 #ifdef ANT_STACK_SUPPORT_REQD
<> 144:ef7eb2e8f9f7 109 // The following two definition is needed only if ANT events are needed to be pulled from the stack.
<> 144:ef7eb2e8f9f7 110 static ant_evt_t m_ant_evt_buffer; /**< Buffer for receiving ANT events from the SoftDevice. */
<> 144:ef7eb2e8f9f7 111 static ant_evt_handler_t m_ant_evt_handler; /**< Application event handler for handling ANT events. */
<> 144:ef7eb2e8f9f7 112 #endif
<> 144:ef7eb2e8f9f7 113
<> 144:ef7eb2e8f9f7 114 static sys_evt_handler_t m_sys_evt_handler; /**< Application event handler for handling System (SOC) events. */
<> 144:ef7eb2e8f9f7 115
<> 144:ef7eb2e8f9f7 116
<> 144:ef7eb2e8f9f7 117 /**@brief Callback function for asserts in the SoftDevice.
<> 144:ef7eb2e8f9f7 118 *
<> 144:ef7eb2e8f9f7 119 * @details A pointer to this function will be passed to the SoftDevice. This function will be
<> 144:ef7eb2e8f9f7 120 * called by the SoftDevice if certain unrecoverable errors occur within the
<> 144:ef7eb2e8f9f7 121 * application or SoftDevice.
<> 144:ef7eb2e8f9f7 122 *
<> 144:ef7eb2e8f9f7 123 * See @ref nrf_fault_handler_t for more details.
<> 144:ef7eb2e8f9f7 124 *
<> 144:ef7eb2e8f9f7 125 * @param[in] id Fault identifier. See @ref NRF_FAULT_IDS.
<> 144:ef7eb2e8f9f7 126 * @param[in] pc The program counter of the instruction that triggered the fault.
<> 144:ef7eb2e8f9f7 127 * @param[in] info Optional additional information regarding the fault. Refer to each fault
<> 144:ef7eb2e8f9f7 128 * identifier for details.
<> 144:ef7eb2e8f9f7 129 */
<> 144:ef7eb2e8f9f7 130 void softdevice_fault_handler(uint32_t id, uint32_t pc, uint32_t info)
<> 144:ef7eb2e8f9f7 131 {
<> 144:ef7eb2e8f9f7 132 app_error_fault_handler(id, pc, info);
<> 144:ef7eb2e8f9f7 133 }
<> 144:ef7eb2e8f9f7 134
<> 144:ef7eb2e8f9f7 135
<> 144:ef7eb2e8f9f7 136 void intern_softdevice_events_execute(void)
<> 144:ef7eb2e8f9f7 137 {
<> 144:ef7eb2e8f9f7 138 if (!m_softdevice_enabled)
<> 144:ef7eb2e8f9f7 139 {
<> 144:ef7eb2e8f9f7 140 // SoftDevice not enabled. This can be possible if the SoftDevice was enabled by the
<> 144:ef7eb2e8f9f7 141 // application without using this module's API (i.e softdevice_handler_init)
<> 144:ef7eb2e8f9f7 142
<> 144:ef7eb2e8f9f7 143 return;
<> 144:ef7eb2e8f9f7 144 }
<> 144:ef7eb2e8f9f7 145 #if CLOCK_ENABLED
<> 144:ef7eb2e8f9f7 146 bool no_more_soc_evts = false;
<> 144:ef7eb2e8f9f7 147 #else
<> 144:ef7eb2e8f9f7 148 bool no_more_soc_evts = (m_sys_evt_handler == NULL);
<> 144:ef7eb2e8f9f7 149 #endif
<> 144:ef7eb2e8f9f7 150 #ifdef BLE_STACK_SUPPORT_REQD
<> 144:ef7eb2e8f9f7 151 bool no_more_ble_evts = (m_ble_evt_handler == NULL);
<> 144:ef7eb2e8f9f7 152 #endif
<> 144:ef7eb2e8f9f7 153 #ifdef ANT_STACK_SUPPORT_REQD
<> 144:ef7eb2e8f9f7 154 bool no_more_ant_evts = (m_ant_evt_handler == NULL);
<> 144:ef7eb2e8f9f7 155 #endif
<> 144:ef7eb2e8f9f7 156
<> 144:ef7eb2e8f9f7 157 for (;;)
<> 144:ef7eb2e8f9f7 158 {
<> 144:ef7eb2e8f9f7 159 uint32_t err_code;
<> 144:ef7eb2e8f9f7 160
<> 144:ef7eb2e8f9f7 161 if (!no_more_soc_evts)
<> 144:ef7eb2e8f9f7 162 {
<> 144:ef7eb2e8f9f7 163 uint32_t evt_id;
<> 144:ef7eb2e8f9f7 164
<> 144:ef7eb2e8f9f7 165 // Pull event from SOC.
<> 144:ef7eb2e8f9f7 166 err_code = sd_evt_get(&evt_id);
<> 144:ef7eb2e8f9f7 167
<> 144:ef7eb2e8f9f7 168 if (err_code == NRF_ERROR_NOT_FOUND)
<> 144:ef7eb2e8f9f7 169 {
<> 144:ef7eb2e8f9f7 170 no_more_soc_evts = true;
<> 144:ef7eb2e8f9f7 171 }
<> 144:ef7eb2e8f9f7 172 else if (err_code != NRF_SUCCESS)
<> 144:ef7eb2e8f9f7 173 {
<> 144:ef7eb2e8f9f7 174 APP_ERROR_HANDLER(err_code);
<> 144:ef7eb2e8f9f7 175 }
<> 144:ef7eb2e8f9f7 176 else
<> 144:ef7eb2e8f9f7 177 {
<> 144:ef7eb2e8f9f7 178 // Call application's SOC event handler.
<> 144:ef7eb2e8f9f7 179 #if CLOCK_ENABLED
<> 144:ef7eb2e8f9f7 180 nrf_drv_clock_on_soc_event(evt_id);
<> 144:ef7eb2e8f9f7 181 if (m_sys_evt_handler)
<> 144:ef7eb2e8f9f7 182 {
<> 144:ef7eb2e8f9f7 183 m_sys_evt_handler(evt_id);
<> 144:ef7eb2e8f9f7 184 }
<> 144:ef7eb2e8f9f7 185 #else
<> 144:ef7eb2e8f9f7 186 m_sys_evt_handler(evt_id);
<> 144:ef7eb2e8f9f7 187 #endif
<> 144:ef7eb2e8f9f7 188 }
<> 144:ef7eb2e8f9f7 189 }
<> 144:ef7eb2e8f9f7 190
<> 144:ef7eb2e8f9f7 191 #ifdef BLE_STACK_SUPPORT_REQD
<> 144:ef7eb2e8f9f7 192 // Fetch BLE Events.
<> 144:ef7eb2e8f9f7 193 if (!no_more_ble_evts)
<> 144:ef7eb2e8f9f7 194 {
<> 144:ef7eb2e8f9f7 195 // Pull event from stack
<> 144:ef7eb2e8f9f7 196 uint16_t evt_len = m_ble_evt_buffer_size;
<> 144:ef7eb2e8f9f7 197
<> 144:ef7eb2e8f9f7 198 err_code = sd_ble_evt_get(mp_ble_evt_buffer, &evt_len);
<> 144:ef7eb2e8f9f7 199 if (err_code == NRF_ERROR_NOT_FOUND)
<> 144:ef7eb2e8f9f7 200 {
<> 144:ef7eb2e8f9f7 201 no_more_ble_evts = true;
<> 144:ef7eb2e8f9f7 202 }
<> 144:ef7eb2e8f9f7 203 else if (err_code != NRF_SUCCESS)
<> 144:ef7eb2e8f9f7 204 {
<> 144:ef7eb2e8f9f7 205 APP_ERROR_HANDLER(err_code);
<> 144:ef7eb2e8f9f7 206 }
<> 144:ef7eb2e8f9f7 207 else
<> 144:ef7eb2e8f9f7 208 {
<> 144:ef7eb2e8f9f7 209 // Call application's BLE stack event handler.
<> 144:ef7eb2e8f9f7 210 m_ble_evt_handler((ble_evt_t *)mp_ble_evt_buffer);
<> 144:ef7eb2e8f9f7 211 }
<> 144:ef7eb2e8f9f7 212 }
<> 144:ef7eb2e8f9f7 213 #endif
<> 144:ef7eb2e8f9f7 214
<> 144:ef7eb2e8f9f7 215 #ifdef ANT_STACK_SUPPORT_REQD
<> 144:ef7eb2e8f9f7 216 // Fetch ANT Events.
<> 144:ef7eb2e8f9f7 217 if (!no_more_ant_evts)
<> 144:ef7eb2e8f9f7 218 {
<> 144:ef7eb2e8f9f7 219 // Pull event from stack
<> 144:ef7eb2e8f9f7 220 err_code = sd_ant_event_get(&m_ant_evt_buffer.channel,
<> 144:ef7eb2e8f9f7 221 &m_ant_evt_buffer.event,
<> 144:ef7eb2e8f9f7 222 m_ant_evt_buffer.msg.evt_buffer);
<> 144:ef7eb2e8f9f7 223 if (err_code == NRF_ERROR_NOT_FOUND)
<> 144:ef7eb2e8f9f7 224 {
<> 144:ef7eb2e8f9f7 225 no_more_ant_evts = true;
<> 144:ef7eb2e8f9f7 226 }
<> 144:ef7eb2e8f9f7 227 else if (err_code != NRF_SUCCESS)
<> 144:ef7eb2e8f9f7 228 {
<> 144:ef7eb2e8f9f7 229 APP_ERROR_HANDLER(err_code);
<> 144:ef7eb2e8f9f7 230 }
<> 144:ef7eb2e8f9f7 231 else
<> 144:ef7eb2e8f9f7 232 {
<> 144:ef7eb2e8f9f7 233 // Call application's ANT stack event handler.
<> 144:ef7eb2e8f9f7 234 m_ant_evt_handler(&m_ant_evt_buffer);
<> 144:ef7eb2e8f9f7 235 }
<> 144:ef7eb2e8f9f7 236 }
<> 144:ef7eb2e8f9f7 237 #endif
<> 144:ef7eb2e8f9f7 238
<> 144:ef7eb2e8f9f7 239 if (no_more_soc_evts)
<> 144:ef7eb2e8f9f7 240 {
<> 144:ef7eb2e8f9f7 241 // There are no remaining System (SOC) events to be fetched from the SoftDevice.
<> 144:ef7eb2e8f9f7 242 #if defined(ANT_STACK_SUPPORT_REQD) && defined(BLE_STACK_SUPPORT_REQD)
<> 144:ef7eb2e8f9f7 243 // Check if there are any remaining BLE and ANT events.
<> 144:ef7eb2e8f9f7 244 if (no_more_ble_evts && no_more_ant_evts)
<> 144:ef7eb2e8f9f7 245 {
<> 144:ef7eb2e8f9f7 246 break;
<> 144:ef7eb2e8f9f7 247 }
<> 144:ef7eb2e8f9f7 248 #elif defined(BLE_STACK_SUPPORT_REQD)
<> 144:ef7eb2e8f9f7 249 // Check if there are any remaining BLE events.
<> 144:ef7eb2e8f9f7 250 if (no_more_ble_evts)
<> 144:ef7eb2e8f9f7 251 {
<> 144:ef7eb2e8f9f7 252 break;
<> 144:ef7eb2e8f9f7 253 }
<> 144:ef7eb2e8f9f7 254 #elif defined(ANT_STACK_SUPPORT_REQD)
<> 144:ef7eb2e8f9f7 255 // Check if there are any remaining ANT events.
<> 144:ef7eb2e8f9f7 256 if (no_more_ant_evts)
<> 144:ef7eb2e8f9f7 257 {
<> 144:ef7eb2e8f9f7 258 break;
<> 144:ef7eb2e8f9f7 259 }
<> 144:ef7eb2e8f9f7 260 #else
<> 144:ef7eb2e8f9f7 261 // No need to check for BLE or ANT events since there is no support for BLE and ANT
<> 144:ef7eb2e8f9f7 262 // required.
<> 144:ef7eb2e8f9f7 263 break;
<> 144:ef7eb2e8f9f7 264 #endif
<> 144:ef7eb2e8f9f7 265 }
<> 144:ef7eb2e8f9f7 266 }
<> 144:ef7eb2e8f9f7 267 }
<> 144:ef7eb2e8f9f7 268
<> 144:ef7eb2e8f9f7 269 bool softdevice_handler_isEnabled(void)
<> 144:ef7eb2e8f9f7 270 {
<> 144:ef7eb2e8f9f7 271 return m_softdevice_enabled;
<> 144:ef7eb2e8f9f7 272 }
<> 144:ef7eb2e8f9f7 273
<> 144:ef7eb2e8f9f7 274 uint32_t softdevice_handler_init(nrf_clock_lf_cfg_t * p_clock_lf_cfg,
<> 144:ef7eb2e8f9f7 275 void * p_ble_evt_buffer,
<> 144:ef7eb2e8f9f7 276 uint16_t ble_evt_buffer_size,
<> 144:ef7eb2e8f9f7 277 softdevice_evt_schedule_func_t evt_schedule_func)
<> 144:ef7eb2e8f9f7 278 {
<> 144:ef7eb2e8f9f7 279 uint32_t err_code;
<> 144:ef7eb2e8f9f7 280
<> 144:ef7eb2e8f9f7 281 SD_HANDLER_LOG_INIT();
<> 144:ef7eb2e8f9f7 282
<> 144:ef7eb2e8f9f7 283 // Save configuration.
<> 144:ef7eb2e8f9f7 284 #if defined (BLE_STACK_SUPPORT_REQD)
<> 144:ef7eb2e8f9f7 285 // Check that buffer is not NULL.
<> 144:ef7eb2e8f9f7 286 if (p_ble_evt_buffer == NULL)
<> 144:ef7eb2e8f9f7 287 {
<> 144:ef7eb2e8f9f7 288 return NRF_ERROR_INVALID_PARAM;
<> 144:ef7eb2e8f9f7 289 }
<> 144:ef7eb2e8f9f7 290
<> 144:ef7eb2e8f9f7 291 // Check that buffer is correctly aligned.
<> 144:ef7eb2e8f9f7 292 if (!is_word_aligned(p_ble_evt_buffer))
<> 144:ef7eb2e8f9f7 293 {
<> 144:ef7eb2e8f9f7 294 return NRF_ERROR_INVALID_PARAM;
<> 144:ef7eb2e8f9f7 295 }
<> 144:ef7eb2e8f9f7 296
<> 144:ef7eb2e8f9f7 297 mp_ble_evt_buffer = (uint8_t *)p_ble_evt_buffer;
<> 144:ef7eb2e8f9f7 298 m_ble_evt_buffer_size = ble_evt_buffer_size;
<> 144:ef7eb2e8f9f7 299 #else
<> 144:ef7eb2e8f9f7 300 // The variables p_ble_evt_buffer and ble_evt_buffer_size is not needed if BLE Stack support
<> 144:ef7eb2e8f9f7 301 // is not required.
<> 144:ef7eb2e8f9f7 302 UNUSED_PARAMETER(p_ble_evt_buffer);
<> 144:ef7eb2e8f9f7 303 UNUSED_PARAMETER(ble_evt_buffer_size);
<> 144:ef7eb2e8f9f7 304 #endif
<> 144:ef7eb2e8f9f7 305
<> 144:ef7eb2e8f9f7 306 m_evt_schedule_func = evt_schedule_func;
<> 144:ef7eb2e8f9f7 307
<> 144:ef7eb2e8f9f7 308 // Initialize SoftDevice.
<> 144:ef7eb2e8f9f7 309 #if defined(S212) || defined(S332)
<> 144:ef7eb2e8f9f7 310 err_code = sd_softdevice_enable(p_clock_lf_cfg, softdevice_fault_handler, ANT_LICENSE_KEY);
<> 144:ef7eb2e8f9f7 311 #else
<> 144:ef7eb2e8f9f7 312 err_code = sd_softdevice_enable(p_clock_lf_cfg, softdevice_fault_handler);
<> 144:ef7eb2e8f9f7 313 #endif
<> 144:ef7eb2e8f9f7 314 if (err_code != NRF_SUCCESS)
<> 144:ef7eb2e8f9f7 315 {
<> 144:ef7eb2e8f9f7 316 return err_code;
<> 144:ef7eb2e8f9f7 317 }
<> 144:ef7eb2e8f9f7 318
<> 144:ef7eb2e8f9f7 319 m_softdevice_enabled = true;
<> 144:ef7eb2e8f9f7 320
<> 144:ef7eb2e8f9f7 321 // Enable BLE event interrupt (interrupt priority has already been set by the stack).
<> 144:ef7eb2e8f9f7 322 #ifdef SOFTDEVICE_PRESENT
<> 144:ef7eb2e8f9f7 323 return sd_nvic_EnableIRQ((IRQn_Type)SOFTDEVICE_EVT_IRQ);
<> 144:ef7eb2e8f9f7 324 #else
<> 144:ef7eb2e8f9f7 325 //In case of Serialization NVIC must be accessed directly.
<> 144:ef7eb2e8f9f7 326 NVIC_EnableIRQ(SOFTDEVICE_EVT_IRQ);
<> 144:ef7eb2e8f9f7 327 return NRF_SUCCESS;
<> 144:ef7eb2e8f9f7 328 #endif
<> 144:ef7eb2e8f9f7 329 }
<> 144:ef7eb2e8f9f7 330
<> 144:ef7eb2e8f9f7 331
<> 144:ef7eb2e8f9f7 332 uint32_t softdevice_handler_sd_disable(void)
<> 144:ef7eb2e8f9f7 333 {
<> 144:ef7eb2e8f9f7 334 uint32_t err_code = sd_softdevice_disable();
<> 144:ef7eb2e8f9f7 335
<> 144:ef7eb2e8f9f7 336 m_softdevice_enabled = !(err_code == NRF_SUCCESS);
<> 144:ef7eb2e8f9f7 337
<> 144:ef7eb2e8f9f7 338 return err_code;
<> 144:ef7eb2e8f9f7 339 }
<> 144:ef7eb2e8f9f7 340
<> 144:ef7eb2e8f9f7 341
<> 144:ef7eb2e8f9f7 342 #ifdef BLE_STACK_SUPPORT_REQD
<> 144:ef7eb2e8f9f7 343 uint32_t softdevice_ble_evt_handler_set(ble_evt_handler_t ble_evt_handler)
<> 144:ef7eb2e8f9f7 344 {
<> 144:ef7eb2e8f9f7 345 VERIFY_PARAM_NOT_NULL(ble_evt_handler);
<> 144:ef7eb2e8f9f7 346
<> 144:ef7eb2e8f9f7 347 m_ble_evt_handler = ble_evt_handler;
<> 144:ef7eb2e8f9f7 348
<> 144:ef7eb2e8f9f7 349 return NRF_SUCCESS;
<> 144:ef7eb2e8f9f7 350 }
<> 144:ef7eb2e8f9f7 351 #endif
<> 144:ef7eb2e8f9f7 352
<> 144:ef7eb2e8f9f7 353
<> 144:ef7eb2e8f9f7 354 #ifdef ANT_STACK_SUPPORT_REQD
<> 144:ef7eb2e8f9f7 355 uint32_t softdevice_ant_evt_handler_set(ant_evt_handler_t ant_evt_handler)
<> 144:ef7eb2e8f9f7 356 {
<> 144:ef7eb2e8f9f7 357 VERIFY_PARAM_NOT_NULL(ant_evt_handler);
<> 144:ef7eb2e8f9f7 358
<> 144:ef7eb2e8f9f7 359 m_ant_evt_handler = ant_evt_handler;
<> 144:ef7eb2e8f9f7 360
<> 144:ef7eb2e8f9f7 361 return NRF_SUCCESS;
<> 144:ef7eb2e8f9f7 362 }
<> 144:ef7eb2e8f9f7 363 #endif
<> 144:ef7eb2e8f9f7 364
<> 144:ef7eb2e8f9f7 365
<> 144:ef7eb2e8f9f7 366 uint32_t softdevice_sys_evt_handler_set(sys_evt_handler_t sys_evt_handler)
<> 144:ef7eb2e8f9f7 367 {
<> 144:ef7eb2e8f9f7 368 VERIFY_PARAM_NOT_NULL(sys_evt_handler);
<> 144:ef7eb2e8f9f7 369
<> 144:ef7eb2e8f9f7 370 m_sys_evt_handler = sys_evt_handler;
<> 144:ef7eb2e8f9f7 371
<> 144:ef7eb2e8f9f7 372 return NRF_SUCCESS;
<> 144:ef7eb2e8f9f7 373 }
<> 144:ef7eb2e8f9f7 374
<> 144:ef7eb2e8f9f7 375
<> 144:ef7eb2e8f9f7 376 /**@brief Function for handling the Application's BLE Stack events interrupt.
<> 144:ef7eb2e8f9f7 377 *
<> 144:ef7eb2e8f9f7 378 * @details This function is called whenever an event is ready to be pulled.
<> 144:ef7eb2e8f9f7 379 */
<> 144:ef7eb2e8f9f7 380 void SOFTDEVICE_EVT_IRQHandler(void)
<> 144:ef7eb2e8f9f7 381 {
<> 144:ef7eb2e8f9f7 382 if (m_evt_schedule_func != NULL)
<> 144:ef7eb2e8f9f7 383 {
<> 144:ef7eb2e8f9f7 384 uint32_t err_code = m_evt_schedule_func();
<> 144:ef7eb2e8f9f7 385 APP_ERROR_CHECK(err_code);
<> 144:ef7eb2e8f9f7 386 }
<> 144:ef7eb2e8f9f7 387 else
<> 144:ef7eb2e8f9f7 388 {
<> 144:ef7eb2e8f9f7 389 intern_softdevice_events_execute();
<> 144:ef7eb2e8f9f7 390 }
<> 144:ef7eb2e8f9f7 391 }
<> 144:ef7eb2e8f9f7 392
<> 144:ef7eb2e8f9f7 393 #if defined(BLE_STACK_SUPPORT_REQD)
<> 144:ef7eb2e8f9f7 394 uint32_t softdevice_enable_get_default_config(uint8_t central_links_count,
<> 144:ef7eb2e8f9f7 395 uint8_t periph_links_count,
<> 144:ef7eb2e8f9f7 396 ble_enable_params_t * p_ble_enable_params)
<> 144:ef7eb2e8f9f7 397 {
<> 144:ef7eb2e8f9f7 398 memset(p_ble_enable_params, 0, sizeof(ble_enable_params_t));
<> 144:ef7eb2e8f9f7 399 p_ble_enable_params->common_enable_params.vs_uuid_count = 1;
<> 144:ef7eb2e8f9f7 400 p_ble_enable_params->gatts_enable_params.attr_tab_size = SOFTDEVICE_GATTS_ATTR_TAB_SIZE;
<> 144:ef7eb2e8f9f7 401 p_ble_enable_params->gatts_enable_params.service_changed = SOFTDEVICE_GATTS_SRV_CHANGED;
<> 144:ef7eb2e8f9f7 402 p_ble_enable_params->gap_enable_params.periph_conn_count = periph_links_count;
<> 144:ef7eb2e8f9f7 403 p_ble_enable_params->gap_enable_params.central_conn_count = central_links_count;
<> 144:ef7eb2e8f9f7 404 if (p_ble_enable_params->gap_enable_params.central_conn_count != 0)
<> 144:ef7eb2e8f9f7 405 {
<> 144:ef7eb2e8f9f7 406 p_ble_enable_params->gap_enable_params.central_sec_count = SOFTDEVICE_CENTRAL_SEC_COUNT;
<> 144:ef7eb2e8f9f7 407 }
<> 144:ef7eb2e8f9f7 408
<> 144:ef7eb2e8f9f7 409 return NRF_SUCCESS;
<> 144:ef7eb2e8f9f7 410 }
<> 144:ef7eb2e8f9f7 411
<> 144:ef7eb2e8f9f7 412
<> 144:ef7eb2e8f9f7 413 #if defined(NRF_LOG_USES_RTT) && NRF_LOG_USES_RTT == 1
<> 144:ef7eb2e8f9f7 414 static inline uint32_t ram_total_size_get(void)
<> 144:ef7eb2e8f9f7 415 {
<> 144:ef7eb2e8f9f7 416 #ifdef NRF51
<> 144:ef7eb2e8f9f7 417 uint32_t size_ram_blocks = (uint32_t)NRF_FICR->SIZERAMBLOCKS;
<> 144:ef7eb2e8f9f7 418 uint32_t total_ram_size = size_ram_blocks;
<> 144:ef7eb2e8f9f7 419 total_ram_size = total_ram_size*(NRF_FICR->NUMRAMBLOCK);
<> 144:ef7eb2e8f9f7 420 return total_ram_size;
<> 144:ef7eb2e8f9f7 421 #elif defined (NRF52)
<> 144:ef7eb2e8f9f7 422 return RAM_TOTAL_SIZE;
<> 144:ef7eb2e8f9f7 423 #endif /* NRF51 */
<> 144:ef7eb2e8f9f7 424 }
<> 144:ef7eb2e8f9f7 425
<> 144:ef7eb2e8f9f7 426 /*lint --e{528} -save suppress 528: symbol not referenced */
<> 144:ef7eb2e8f9f7 427 /**@brief Function for finding the end address of the RAM.
<> 144:ef7eb2e8f9f7 428 *
<> 144:ef7eb2e8f9f7 429 * @retval ram_end_address Address of the end of the RAM.
<> 144:ef7eb2e8f9f7 430 */
<> 144:ef7eb2e8f9f7 431 static inline uint32_t ram_end_address_get(void)
<> 144:ef7eb2e8f9f7 432 {
<> 144:ef7eb2e8f9f7 433 uint32_t ram_end_address = (uint32_t)RAM_START_ADDRESS;
<> 144:ef7eb2e8f9f7 434 ram_end_address+= ram_total_size_get();
<> 144:ef7eb2e8f9f7 435 return ram_end_address;
<> 144:ef7eb2e8f9f7 436 }
<> 144:ef7eb2e8f9f7 437 /*lint -restore*/
<> 144:ef7eb2e8f9f7 438 #endif //ENABLE_DEBUG_LOG_SUPPORT
<> 144:ef7eb2e8f9f7 439
<> 144:ef7eb2e8f9f7 440 /*lint --e{10} --e{19} --e{27} --e{40} --e{529} -save suppress Error 27: Illegal character */
<> 144:ef7eb2e8f9f7 441 uint32_t sd_check_ram_start(uint32_t sd_req_ram_start)
<> 144:ef7eb2e8f9f7 442 {
<> 144:ef7eb2e8f9f7 443 #if (defined(S130) || defined(S132) || defined(S332))
AnnaBridge 174:b96e65c34a4d 444 #if defined ( __CC_ARM ) || (defined(__ARMCC_VERSION) && (__ARMCC_VERSION >= 6010050))
<> 144:ef7eb2e8f9f7 445 extern uint32_t Image$$RW_IRAM1$$Base;
<> 144:ef7eb2e8f9f7 446 const volatile uint32_t ram_start = (uint32_t) &Image$$RW_IRAM1$$Base;
<> 144:ef7eb2e8f9f7 447 #elif defined ( __ICCARM__ )
<> 144:ef7eb2e8f9f7 448 extern uint32_t __ICFEDIT_region_RAM_start__;
<> 144:ef7eb2e8f9f7 449 volatile uint32_t ram_start = (uint32_t) &__ICFEDIT_region_RAM_start__;
<> 144:ef7eb2e8f9f7 450 #elif defined ( __GNUC__ )
<> 144:ef7eb2e8f9f7 451 extern uint32_t __data_start__;
<> 144:ef7eb2e8f9f7 452 volatile uint32_t ram_start = (uint32_t) &__data_start__;
<> 144:ef7eb2e8f9f7 453 #endif//__CC_ARM
<> 144:ef7eb2e8f9f7 454 if (ram_start != sd_req_ram_start)
<> 144:ef7eb2e8f9f7 455 {
<> 144:ef7eb2e8f9f7 456 #if defined(NRF_LOG_USES_RTT) && NRF_LOG_USES_RTT == 1
<> 144:ef7eb2e8f9f7 457 uint32_t app_ram_size= ram_end_address_get();
<> 144:ef7eb2e8f9f7 458 SD_HANDLER_LOG("RAM START ADDR 0x%x should be adjusted to 0x%x\r\n",
<> 144:ef7eb2e8f9f7 459 ram_start,
<> 144:ef7eb2e8f9f7 460 sd_req_ram_start);
<> 144:ef7eb2e8f9f7 461 app_ram_size -= sd_req_ram_start;
<> 144:ef7eb2e8f9f7 462 SD_HANDLER_LOG("RAM SIZE should be adjusted to 0x%x \r\n",
<> 144:ef7eb2e8f9f7 463 app_ram_size);
<> 144:ef7eb2e8f9f7 464 #endif //NRF_LOG_USES_RTT
<> 144:ef7eb2e8f9f7 465 return NRF_SUCCESS;
<> 144:ef7eb2e8f9f7 466 }
<> 144:ef7eb2e8f9f7 467 #endif//defined(S130) || defined(S132) || defined(S332)
<> 144:ef7eb2e8f9f7 468 return NRF_SUCCESS;
<> 144:ef7eb2e8f9f7 469 }
<> 144:ef7eb2e8f9f7 470
<> 144:ef7eb2e8f9f7 471 uint32_t softdevice_enable(ble_enable_params_t * p_ble_enable_params)
<> 144:ef7eb2e8f9f7 472 {
<> 144:ef7eb2e8f9f7 473 #if (defined(S130) || defined(S132) || defined(S332))
<> 144:ef7eb2e8f9f7 474 uint32_t err_code;
<> 144:ef7eb2e8f9f7 475 uint32_t app_ram_base;
<> 144:ef7eb2e8f9f7 476
AnnaBridge 174:b96e65c34a4d 477 #if defined ( __CC_ARM ) || (defined(__ARMCC_VERSION) && (__ARMCC_VERSION >= 6010050))
<> 144:ef7eb2e8f9f7 478 extern uint32_t Image$$RW_IRAM1$$Base;
<> 144:ef7eb2e8f9f7 479 const volatile uint32_t ram_start = (uint32_t) &Image$$RW_IRAM1$$Base;
<> 144:ef7eb2e8f9f7 480 #elif defined ( __ICCARM__ )
<> 144:ef7eb2e8f9f7 481 extern uint32_t __ICFEDIT_region_RAM_start__;
<> 144:ef7eb2e8f9f7 482 volatile uint32_t ram_start = (uint32_t) &__ICFEDIT_region_RAM_start__;
<> 144:ef7eb2e8f9f7 483 #elif defined ( __GNUC__ )
<> 144:ef7eb2e8f9f7 484 extern uint32_t __data_start__;
<> 144:ef7eb2e8f9f7 485 volatile uint32_t ram_start = (uint32_t) &__data_start__;
<> 144:ef7eb2e8f9f7 486 #endif
<> 144:ef7eb2e8f9f7 487
<> 144:ef7eb2e8f9f7 488 app_ram_base = ram_start;
<> 144:ef7eb2e8f9f7 489 SD_HANDLER_LOG("sd_ble_enable: RAM START at 0x%x\r\n",
<> 144:ef7eb2e8f9f7 490 app_ram_base);
<> 144:ef7eb2e8f9f7 491 err_code = sd_ble_enable(p_ble_enable_params, &app_ram_base);
<> 144:ef7eb2e8f9f7 492
<> 144:ef7eb2e8f9f7 493 #if defined(NRF_LOG_USES_RTT) && NRF_LOG_USES_RTT == 1
<> 144:ef7eb2e8f9f7 494 if (app_ram_base != ram_start)
<> 144:ef7eb2e8f9f7 495 {
<> 144:ef7eb2e8f9f7 496 uint32_t app_ram_size= ram_end_address_get();
<> 144:ef7eb2e8f9f7 497 SD_HANDLER_LOG("sd_ble_enable: app_ram_base should be adjusted to 0x%x\r\n",
<> 144:ef7eb2e8f9f7 498 app_ram_base);
<> 144:ef7eb2e8f9f7 499 app_ram_size -= app_ram_base;
<> 144:ef7eb2e8f9f7 500 SD_HANDLER_LOG("ram size should be adjusted to 0x%x \r\n",
<> 144:ef7eb2e8f9f7 501 app_ram_size);
<> 144:ef7eb2e8f9f7 502 }
<> 144:ef7eb2e8f9f7 503 else if (err_code != NRF_SUCCESS)
<> 144:ef7eb2e8f9f7 504 {
<> 144:ef7eb2e8f9f7 505 SD_HANDLER_LOG("sd_ble_enable: error 0x%x\r\n", err_code);
<> 144:ef7eb2e8f9f7 506 while(1);
<> 144:ef7eb2e8f9f7 507 }
<> 144:ef7eb2e8f9f7 508 #endif // NRF_LOG_USES_RTT
<> 144:ef7eb2e8f9f7 509 return err_code;
<> 144:ef7eb2e8f9f7 510 #else
<> 144:ef7eb2e8f9f7 511 return NRF_SUCCESS;
<> 144:ef7eb2e8f9f7 512 #endif //defined(S130) || defined(S132) || defined(S332)
<> 144:ef7eb2e8f9f7 513
<> 144:ef7eb2e8f9f7 514 }
<> 144:ef7eb2e8f9f7 515 /*lint -restore*/
<> 144:ef7eb2e8f9f7 516
<> 144:ef7eb2e8f9f7 517 #endif //BLE_STACK_SUPPORT_REQD