Nordic Semiconductor / nrf51-sdk

Nordic nrf51 sdk sources. Mirrored from https://github.com/ARMmbed/nrf51-sdk.

Dependents:   nRF51822 nRF51822

source/nordic_sdk/components/ble/common/ble_conn_params.c@19:47192cb9def7, 2016-04-07 (annotated)

Committer:
vcoubard
Date:
Thu Apr 07 17:37:40 2016 +0100
Revision:
19:47192cb9def7
Child:
20:a90c48eb1d30
Synchronized with git rev 9251259f

Author: Liyou Zhou

Copy over coresponding files from nordic-sdk 9.0.0

Who changed what in which revision?

UserRevisionLine numberNew contents of line
vcoubard 19:47192cb9def7 1 /* Copyright (c) 2012 Nordic Semiconductor. All Rights Reserved.
vcoubard 19:47192cb9def7 2 *
vcoubard 19:47192cb9def7 3 * The information contained herein is property of Nordic Semiconductor ASA.
vcoubard 19:47192cb9def7 4 * Terms and conditions of usage are described in detail in NORDIC
vcoubard 19:47192cb9def7 5 * SEMICONDUCTOR STANDARD SOFTWARE LICENSE AGREEMENT.
vcoubard 19:47192cb9def7 6 *
vcoubard 19:47192cb9def7 7 * Licensees are granted free, non-transferable use of the information. NO
vcoubard 19:47192cb9def7 8 * WARRANTY of ANY KIND is provided. This heading must NOT be removed from
vcoubard 19:47192cb9def7 9 * the file.
vcoubard 19:47192cb9def7 10 *
vcoubard 19:47192cb9def7 11 */
vcoubard 19:47192cb9def7 12
vcoubard 19:47192cb9def7 13 #include "ble_conn_params.h"
vcoubard 19:47192cb9def7 14 #include <stdlib.h>
vcoubard 19:47192cb9def7 15 #include "nordic_common.h"
vcoubard 19:47192cb9def7 16 #include "ble_hci.h"
vcoubard 19:47192cb9def7 17 #include "app_timer.h"
vcoubard 19:47192cb9def7 18 #include "ble_srv_common.h"
vcoubard 19:47192cb9def7 19 #include "app_util.h"
vcoubard 19:47192cb9def7 20
vcoubard 19:47192cb9def7 21
vcoubard 19:47192cb9def7 22 static ble_conn_params_init_t m_conn_params_config; /**< Configuration as specified by the application. */
vcoubard 19:47192cb9def7 23 static ble_gap_conn_params_t m_preferred_conn_params; /**< Connection parameters preferred by the application. */
vcoubard 19:47192cb9def7 24 static uint8_t m_update_count; /**< Number of Connection Parameter Update messages that has currently been sent. */
vcoubard 19:47192cb9def7 25 static uint16_t m_conn_handle; /**< Current connection handle. */
vcoubard 19:47192cb9def7 26 static ble_gap_conn_params_t m_current_conn_params; /**< Connection parameters received in the most recent Connect event. */
vcoubard 19:47192cb9def7 27 static app_timer_id_t m_conn_params_timer_id; /**< Connection parameters timer. */
vcoubard 19:47192cb9def7 28
vcoubard 19:47192cb9def7 29 static bool m_change_param = false;
vcoubard 19:47192cb9def7 30
vcoubard 19:47192cb9def7 31 static bool is_conn_params_ok(ble_gap_conn_params_t * p_conn_params)
vcoubard 19:47192cb9def7 32 {
vcoubard 19:47192cb9def7 33 // Check if interval is within the acceptable range.
vcoubard 19:47192cb9def7 34 // NOTE: Using max_conn_interval in the received event data because this contains
vcoubard 19:47192cb9def7 35 // the client's connection interval.
vcoubard 19:47192cb9def7 36 if (
vcoubard 19:47192cb9def7 37 (p_conn_params->max_conn_interval >= m_preferred_conn_params.min_conn_interval)
vcoubard 19:47192cb9def7 38 &&
vcoubard 19:47192cb9def7 39 (p_conn_params->max_conn_interval <= m_preferred_conn_params.max_conn_interval)
vcoubard 19:47192cb9def7 40 )
vcoubard 19:47192cb9def7 41 {
vcoubard 19:47192cb9def7 42 return true;
vcoubard 19:47192cb9def7 43 }
vcoubard 19:47192cb9def7 44 else
vcoubard 19:47192cb9def7 45 {
vcoubard 19:47192cb9def7 46 return false;
vcoubard 19:47192cb9def7 47 }
vcoubard 19:47192cb9def7 48 }
vcoubard 19:47192cb9def7 49
vcoubard 19:47192cb9def7 50
vcoubard 19:47192cb9def7 51 static void update_timeout_handler(void * p_context)
vcoubard 19:47192cb9def7 52 {
vcoubard 19:47192cb9def7 53 UNUSED_PARAMETER(p_context);
vcoubard 19:47192cb9def7 54
vcoubard 19:47192cb9def7 55 if (m_conn_handle != BLE_CONN_HANDLE_INVALID)
vcoubard 19:47192cb9def7 56 {
vcoubard 19:47192cb9def7 57 // Check if we have reached the maximum number of attempts
vcoubard 19:47192cb9def7 58 m_update_count++;
vcoubard 19:47192cb9def7 59 if (m_update_count <= m_conn_params_config.max_conn_params_update_count)
vcoubard 19:47192cb9def7 60 {
vcoubard 19:47192cb9def7 61 uint32_t err_code;
vcoubard 19:47192cb9def7 62
vcoubard 19:47192cb9def7 63 // Parameters are not ok, send connection parameters update request.
vcoubard 19:47192cb9def7 64 err_code = sd_ble_gap_conn_param_update(m_conn_handle, &m_preferred_conn_params);
vcoubard 19:47192cb9def7 65 if ((err_code != NRF_SUCCESS) && (m_conn_params_config.error_handler != NULL))
vcoubard 19:47192cb9def7 66 {
vcoubard 19:47192cb9def7 67 m_conn_params_config.error_handler(err_code);
vcoubard 19:47192cb9def7 68 }
vcoubard 19:47192cb9def7 69 }
vcoubard 19:47192cb9def7 70 else
vcoubard 19:47192cb9def7 71 {
vcoubard 19:47192cb9def7 72 m_update_count = 0;
vcoubard 19:47192cb9def7 73
vcoubard 19:47192cb9def7 74 // Negotiation failed, disconnect automatically if this has been configured
vcoubard 19:47192cb9def7 75 if (m_conn_params_config.disconnect_on_fail)
vcoubard 19:47192cb9def7 76 {
vcoubard 19:47192cb9def7 77 uint32_t err_code;
vcoubard 19:47192cb9def7 78
vcoubard 19:47192cb9def7 79 err_code = sd_ble_gap_disconnect(m_conn_handle, BLE_HCI_CONN_INTERVAL_UNACCEPTABLE);
vcoubard 19:47192cb9def7 80 if ((err_code != NRF_SUCCESS) && (m_conn_params_config.error_handler != NULL))
vcoubard 19:47192cb9def7 81 {
vcoubard 19:47192cb9def7 82 m_conn_params_config.error_handler(err_code);
vcoubard 19:47192cb9def7 83 }
vcoubard 19:47192cb9def7 84 }
vcoubard 19:47192cb9def7 85
vcoubard 19:47192cb9def7 86 // Notify the application that the procedure has failed
vcoubard 19:47192cb9def7 87 if (m_conn_params_config.evt_handler != NULL)
vcoubard 19:47192cb9def7 88 {
vcoubard 19:47192cb9def7 89 ble_conn_params_evt_t evt;
vcoubard 19:47192cb9def7 90
vcoubard 19:47192cb9def7 91 evt.evt_type = BLE_CONN_PARAMS_EVT_FAILED;
vcoubard 19:47192cb9def7 92 m_conn_params_config.evt_handler(&evt);
vcoubard 19:47192cb9def7 93 }
vcoubard 19:47192cb9def7 94 }
vcoubard 19:47192cb9def7 95 }
vcoubard 19:47192cb9def7 96 }
vcoubard 19:47192cb9def7 97
vcoubard 19:47192cb9def7 98
vcoubard 19:47192cb9def7 99 uint32_t ble_conn_params_init(const ble_conn_params_init_t * p_init)
vcoubard 19:47192cb9def7 100 {
vcoubard 19:47192cb9def7 101 uint32_t err_code;
vcoubard 19:47192cb9def7 102
vcoubard 19:47192cb9def7 103 m_conn_params_config = *p_init;
vcoubard 19:47192cb9def7 104 m_change_param = false;
vcoubard 19:47192cb9def7 105 if (p_init->p_conn_params != NULL)
vcoubard 19:47192cb9def7 106 {
vcoubard 19:47192cb9def7 107 m_preferred_conn_params = *p_init->p_conn_params;
vcoubard 19:47192cb9def7 108
vcoubard 19:47192cb9def7 109 // Set the connection params in stack
vcoubard 19:47192cb9def7 110 err_code = sd_ble_gap_ppcp_set(&m_preferred_conn_params);
vcoubard 19:47192cb9def7 111 if (err_code != NRF_SUCCESS)
vcoubard 19:47192cb9def7 112 {
vcoubard 19:47192cb9def7 113 return err_code;
vcoubard 19:47192cb9def7 114 }
vcoubard 19:47192cb9def7 115 }
vcoubard 19:47192cb9def7 116 else
vcoubard 19:47192cb9def7 117 {
vcoubard 19:47192cb9def7 118 // Fetch the connection params from stack
vcoubard 19:47192cb9def7 119 err_code = sd_ble_gap_ppcp_get(&m_preferred_conn_params);
vcoubard 19:47192cb9def7 120 if (err_code != NRF_SUCCESS)
vcoubard 19:47192cb9def7 121 {
vcoubard 19:47192cb9def7 122 return err_code;
vcoubard 19:47192cb9def7 123 }
vcoubard 19:47192cb9def7 124 }
vcoubard 19:47192cb9def7 125
vcoubard 19:47192cb9def7 126 m_conn_handle = BLE_CONN_HANDLE_INVALID;
vcoubard 19:47192cb9def7 127 m_update_count = 0;
vcoubard 19:47192cb9def7 128
vcoubard 19:47192cb9def7 129 return app_timer_create(&m_conn_params_timer_id,
vcoubard 19:47192cb9def7 130 APP_TIMER_MODE_SINGLE_SHOT,
vcoubard 19:47192cb9def7 131 update_timeout_handler);
vcoubard 19:47192cb9def7 132 }
vcoubard 19:47192cb9def7 133
vcoubard 19:47192cb9def7 134
vcoubard 19:47192cb9def7 135 uint32_t ble_conn_params_stop(void)
vcoubard 19:47192cb9def7 136 {
vcoubard 19:47192cb9def7 137 return app_timer_stop(m_conn_params_timer_id);
vcoubard 19:47192cb9def7 138 }
vcoubard 19:47192cb9def7 139
vcoubard 19:47192cb9def7 140
vcoubard 19:47192cb9def7 141 static void conn_params_negotiation(void)
vcoubard 19:47192cb9def7 142 {
vcoubard 19:47192cb9def7 143 // Start negotiation if the received connection parameters are not acceptable
vcoubard 19:47192cb9def7 144 if (!is_conn_params_ok(&m_current_conn_params))
vcoubard 19:47192cb9def7 145 {
vcoubard 19:47192cb9def7 146 uint32_t err_code;
vcoubard 19:47192cb9def7 147 uint32_t timeout_ticks;
vcoubard 19:47192cb9def7 148
vcoubard 19:47192cb9def7 149 if (m_change_param)
vcoubard 19:47192cb9def7 150 {
vcoubard 19:47192cb9def7 151 // Notify the application that the procedure has failed
vcoubard 19:47192cb9def7 152 if (m_conn_params_config.evt_handler != NULL)
vcoubard 19:47192cb9def7 153 {
vcoubard 19:47192cb9def7 154 ble_conn_params_evt_t evt;
vcoubard 19:47192cb9def7 155
vcoubard 19:47192cb9def7 156 evt.evt_type = BLE_CONN_PARAMS_EVT_FAILED;
vcoubard 19:47192cb9def7 157 m_conn_params_config.evt_handler(&evt);
vcoubard 19:47192cb9def7 158 }
vcoubard 19:47192cb9def7 159 }
vcoubard 19:47192cb9def7 160 else
vcoubard 19:47192cb9def7 161 {
vcoubard 19:47192cb9def7 162 if (m_update_count == 0)
vcoubard 19:47192cb9def7 163 {
vcoubard 19:47192cb9def7 164 // First connection parameter update
vcoubard 19:47192cb9def7 165 timeout_ticks = m_conn_params_config.first_conn_params_update_delay;
vcoubard 19:47192cb9def7 166 }
vcoubard 19:47192cb9def7 167 else
vcoubard 19:47192cb9def7 168 {
vcoubard 19:47192cb9def7 169 timeout_ticks = m_conn_params_config.next_conn_params_update_delay;
vcoubard 19:47192cb9def7 170 }
vcoubard 19:47192cb9def7 171
vcoubard 19:47192cb9def7 172 err_code = app_timer_start(m_conn_params_timer_id, timeout_ticks, NULL);
vcoubard 19:47192cb9def7 173 if ((err_code != NRF_SUCCESS) && (m_conn_params_config.error_handler != NULL))
vcoubard 19:47192cb9def7 174 {
vcoubard 19:47192cb9def7 175 m_conn_params_config.error_handler(err_code);
vcoubard 19:47192cb9def7 176 }
vcoubard 19:47192cb9def7 177 }
vcoubard 19:47192cb9def7 178 }
vcoubard 19:47192cb9def7 179 else
vcoubard 19:47192cb9def7 180 {
vcoubard 19:47192cb9def7 181 // Notify the application that the procedure has succeded
vcoubard 19:47192cb9def7 182 if (m_conn_params_config.evt_handler != NULL)
vcoubard 19:47192cb9def7 183 {
vcoubard 19:47192cb9def7 184 ble_conn_params_evt_t evt;
vcoubard 19:47192cb9def7 185
vcoubard 19:47192cb9def7 186 evt.evt_type = BLE_CONN_PARAMS_EVT_SUCCEEDED;
vcoubard 19:47192cb9def7 187 m_conn_params_config.evt_handler(&evt);
vcoubard 19:47192cb9def7 188 }
vcoubard 19:47192cb9def7 189 }
vcoubard 19:47192cb9def7 190 m_change_param = false;
vcoubard 19:47192cb9def7 191 }
vcoubard 19:47192cb9def7 192
vcoubard 19:47192cb9def7 193
vcoubard 19:47192cb9def7 194 static void on_connect(ble_evt_t * p_ble_evt)
vcoubard 19:47192cb9def7 195 {
vcoubard 19:47192cb9def7 196 // Save connection parameters
vcoubard 19:47192cb9def7 197 m_conn_handle = p_ble_evt->evt.gap_evt.conn_handle;
vcoubard 19:47192cb9def7 198 m_current_conn_params = p_ble_evt->evt.gap_evt.params.connected.conn_params;
vcoubard 19:47192cb9def7 199 m_update_count = 0; // Connection parameter negotiation should re-start every connection
vcoubard 19:47192cb9def7 200
vcoubard 19:47192cb9def7 201 // Check if we shall handle negotiation on connect
vcoubard 19:47192cb9def7 202 if (m_conn_params_config.start_on_notify_cccd_handle == BLE_GATT_HANDLE_INVALID)
vcoubard 19:47192cb9def7 203 {
vcoubard 19:47192cb9def7 204 conn_params_negotiation();
vcoubard 19:47192cb9def7 205 }
vcoubard 19:47192cb9def7 206 }
vcoubard 19:47192cb9def7 207
vcoubard 19:47192cb9def7 208
vcoubard 19:47192cb9def7 209 static void on_disconnect(ble_evt_t * p_ble_evt)
vcoubard 19:47192cb9def7 210 {
vcoubard 19:47192cb9def7 211 uint32_t err_code;
vcoubard 19:47192cb9def7 212
vcoubard 19:47192cb9def7 213 m_conn_handle = BLE_CONN_HANDLE_INVALID;
vcoubard 19:47192cb9def7 214
vcoubard 19:47192cb9def7 215 // Stop timer if running
vcoubard 19:47192cb9def7 216 m_update_count = 0; // Connection parameters updates should happen during every connection
vcoubard 19:47192cb9def7 217
vcoubard 19:47192cb9def7 218 err_code = app_timer_stop(m_conn_params_timer_id);
vcoubard 19:47192cb9def7 219 if ((err_code != NRF_SUCCESS) && (m_conn_params_config.error_handler != NULL))
vcoubard 19:47192cb9def7 220 {
vcoubard 19:47192cb9def7 221 m_conn_params_config.error_handler(err_code);
vcoubard 19:47192cb9def7 222 }
vcoubard 19:47192cb9def7 223 }
vcoubard 19:47192cb9def7 224
vcoubard 19:47192cb9def7 225
vcoubard 19:47192cb9def7 226 static void on_write(ble_evt_t * p_ble_evt)
vcoubard 19:47192cb9def7 227 {
vcoubard 19:47192cb9def7 228 ble_gatts_evt_write_t * p_evt_write = &p_ble_evt->evt.gatts_evt.params.write;
vcoubard 19:47192cb9def7 229
vcoubard 19:47192cb9def7 230 // Check if this the correct CCCD
vcoubard 19:47192cb9def7 231 if (
vcoubard 19:47192cb9def7 232 (p_evt_write->handle == m_conn_params_config.start_on_notify_cccd_handle)
vcoubard 19:47192cb9def7 233 &&
vcoubard 19:47192cb9def7 234 (p_evt_write->len == 2)
vcoubard 19:47192cb9def7 235 )
vcoubard 19:47192cb9def7 236 {
vcoubard 19:47192cb9def7 237 // Check if this is a 'start notification'
vcoubard 19:47192cb9def7 238 if (ble_srv_is_notification_enabled(p_evt_write->data))
vcoubard 19:47192cb9def7 239 {
vcoubard 19:47192cb9def7 240 // Do connection parameter negotiation if necessary
vcoubard 19:47192cb9def7 241 conn_params_negotiation();
vcoubard 19:47192cb9def7 242 }
vcoubard 19:47192cb9def7 243 else
vcoubard 19:47192cb9def7 244 {
vcoubard 19:47192cb9def7 245 uint32_t err_code;
vcoubard 19:47192cb9def7 246
vcoubard 19:47192cb9def7 247 // Stop timer if running
vcoubard 19:47192cb9def7 248 err_code = app_timer_stop(m_conn_params_timer_id);
vcoubard 19:47192cb9def7 249 if ((err_code != NRF_SUCCESS) && (m_conn_params_config.error_handler != NULL))
vcoubard 19:47192cb9def7 250 {
vcoubard 19:47192cb9def7 251 m_conn_params_config.error_handler(err_code);
vcoubard 19:47192cb9def7 252 }
vcoubard 19:47192cb9def7 253 }
vcoubard 19:47192cb9def7 254 }
vcoubard 19:47192cb9def7 255 }
vcoubard 19:47192cb9def7 256
vcoubard 19:47192cb9def7 257
vcoubard 19:47192cb9def7 258 static void on_conn_params_update(ble_evt_t * p_ble_evt)
vcoubard 19:47192cb9def7 259 {
vcoubard 19:47192cb9def7 260 // Copy the parameters
vcoubard 19:47192cb9def7 261 m_current_conn_params = p_ble_evt->evt.gap_evt.params.conn_param_update.conn_params;
vcoubard 19:47192cb9def7 262
vcoubard 19:47192cb9def7 263 conn_params_negotiation();
vcoubard 19:47192cb9def7 264 }
vcoubard 19:47192cb9def7 265
vcoubard 19:47192cb9def7 266
vcoubard 19:47192cb9def7 267 void ble_conn_params_on_ble_evt(ble_evt_t * p_ble_evt)
vcoubard 19:47192cb9def7 268 {
vcoubard 19:47192cb9def7 269 switch (p_ble_evt->header.evt_id)
vcoubard 19:47192cb9def7 270 {
vcoubard 19:47192cb9def7 271 case BLE_GAP_EVT_CONNECTED:
vcoubard 19:47192cb9def7 272 on_connect(p_ble_evt);
vcoubard 19:47192cb9def7 273 break;
vcoubard 19:47192cb9def7 274
vcoubard 19:47192cb9def7 275 case BLE_GAP_EVT_DISCONNECTED:
vcoubard 19:47192cb9def7 276 on_disconnect(p_ble_evt);
vcoubard 19:47192cb9def7 277 break;
vcoubard 19:47192cb9def7 278
vcoubard 19:47192cb9def7 279 case BLE_GATTS_EVT_WRITE:
vcoubard 19:47192cb9def7 280 on_write(p_ble_evt);
vcoubard 19:47192cb9def7 281 break;
vcoubard 19:47192cb9def7 282
vcoubard 19:47192cb9def7 283 case BLE_GAP_EVT_CONN_PARAM_UPDATE:
vcoubard 19:47192cb9def7 284 on_conn_params_update(p_ble_evt);
vcoubard 19:47192cb9def7 285 break;
vcoubard 19:47192cb9def7 286
vcoubard 19:47192cb9def7 287 default:
vcoubard 19:47192cb9def7 288 // No implementation needed.
vcoubard 19:47192cb9def7 289 break;
vcoubard 19:47192cb9def7 290 }
vcoubard 19:47192cb9def7 291 }
vcoubard 19:47192cb9def7 292
vcoubard 19:47192cb9def7 293
vcoubard 19:47192cb9def7 294 uint32_t ble_conn_params_change_conn_params(ble_gap_conn_params_t * new_params)
vcoubard 19:47192cb9def7 295 {
vcoubard 19:47192cb9def7 296 uint32_t err_code;
vcoubard 19:47192cb9def7 297
vcoubard 19:47192cb9def7 298 m_preferred_conn_params = *new_params;
vcoubard 19:47192cb9def7 299 // Set the connection params in stack
vcoubard 19:47192cb9def7 300 err_code = sd_ble_gap_ppcp_set(&m_preferred_conn_params);
vcoubard 19:47192cb9def7 301 if (err_code == NRF_SUCCESS)
vcoubard 19:47192cb9def7 302 {
vcoubard 19:47192cb9def7 303 if (!is_conn_params_ok(&m_current_conn_params))
vcoubard 19:47192cb9def7 304 {
vcoubard 19:47192cb9def7 305 m_change_param = true;
vcoubard 19:47192cb9def7 306 err_code = sd_ble_gap_conn_param_update(m_conn_handle, &m_preferred_conn_params);
vcoubard 19:47192cb9def7 307 m_update_count = 1;
vcoubard 19:47192cb9def7 308 }
vcoubard 19:47192cb9def7 309 else
vcoubard 19:47192cb9def7 310 {
vcoubard 19:47192cb9def7 311 // Notify the application that the procedure has succeded
vcoubard 19:47192cb9def7 312 if (m_conn_params_config.evt_handler != NULL)
vcoubard 19:47192cb9def7 313 {
vcoubard 19:47192cb9def7 314 ble_conn_params_evt_t evt;
vcoubard 19:47192cb9def7 315
vcoubard 19:47192cb9def7 316 evt.evt_type = BLE_CONN_PARAMS_EVT_SUCCEEDED;
vcoubard 19:47192cb9def7 317 m_conn_params_config.evt_handler(&evt);
vcoubard 19:47192cb9def7 318 }
vcoubard 19:47192cb9def7 319 err_code = NRF_SUCCESS;
vcoubard 19:47192cb9def7 320 }
vcoubard 19:47192cb9def7 321 }
vcoubard 19:47192cb9def7 322 return err_code;
vcoubard 19:47192cb9def7 323 }