Jinu Andrews / nRF51

lib/ble/src/ble_conn_params.c@0:6ba9b94b8997, 2017-02-09 (annotated)

Committer:
jinu
Date:
Thu Feb 09 06:08:17 2017 +0000
Revision:
0:6ba9b94b8997
NRF51 serialization libraries for mDot

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jinu 0:6ba9b94b8997 1 /* Copyright (c) Nordic Semiconductor ASA
jinu 0:6ba9b94b8997 2 * All rights reserved.
jinu 0:6ba9b94b8997 3 *
jinu 0:6ba9b94b8997 4 * Redistribution and use in source and binary forms, with or without modification,
jinu 0:6ba9b94b8997 5 * are permitted provided that the following conditions are met:
jinu 0:6ba9b94b8997 6 *
jinu 0:6ba9b94b8997 7 * 1. Redistributions of source code must retain the above copyright notice, this
jinu 0:6ba9b94b8997 8 * list of conditions and the following disclaimer.
jinu 0:6ba9b94b8997 9 *
jinu 0:6ba9b94b8997 10 * 2. Redistributions in binary form must reproduce the above copyright notice, this
jinu 0:6ba9b94b8997 11 * list of conditions and the following disclaimer in the documentation and/or
jinu 0:6ba9b94b8997 12 * other materials provided with the distribution.
jinu 0:6ba9b94b8997 13 *
jinu 0:6ba9b94b8997 14 * 3. Neither the name of Nordic Semiconductor ASA nor the names of other
jinu 0:6ba9b94b8997 15 * contributors to this software may be used to endorse or promote products
jinu 0:6ba9b94b8997 16 * derived from this software without specific prior written permission.
jinu 0:6ba9b94b8997 17 *
jinu 0:6ba9b94b8997 18 * 4. This software must only be used in a processor manufactured by Nordic
jinu 0:6ba9b94b8997 19 * Semiconductor ASA, or in a processor manufactured by a third party that
jinu 0:6ba9b94b8997 20 * is used in combination with a processor manufactured by Nordic Semiconductor.
jinu 0:6ba9b94b8997 21 *
jinu 0:6ba9b94b8997 22 *
jinu 0:6ba9b94b8997 23 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
jinu 0:6ba9b94b8997 24 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
jinu 0:6ba9b94b8997 25 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
jinu 0:6ba9b94b8997 26 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR
jinu 0:6ba9b94b8997 27 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
jinu 0:6ba9b94b8997 28 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
jinu 0:6ba9b94b8997 29 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
jinu 0:6ba9b94b8997 30 * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
jinu 0:6ba9b94b8997 31 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
jinu 0:6ba9b94b8997 32 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
jinu 0:6ba9b94b8997 33 */
jinu 0:6ba9b94b8997 34
jinu 0:6ba9b94b8997 35 #include "ble_conn_params.h"
jinu 0:6ba9b94b8997 36 #include <stdlib.h>
jinu 0:6ba9b94b8997 37 #include "ble_util.h"
jinu 0:6ba9b94b8997 38 #include "ble_hci.h"
jinu 0:6ba9b94b8997 39 #include "ble_timer.h"
jinu 0:6ba9b94b8997 40 #include "ble_srv_common.h"
jinu 0:6ba9b94b8997 41 #include "blocking.h"
jinu 0:6ba9b94b8997 42 #include "app_error.h"
jinu 0:6ba9b94b8997 43
jinu 0:6ba9b94b8997 44 static ble_conn_params_init_t m_conn_params_config; /**< Configuration as specified by the application. */
jinu 0:6ba9b94b8997 45 static ble_gap_conn_params_t m_preferred_conn_params; /**< Connection parameters preferred by the application. */
jinu 0:6ba9b94b8997 46 static uint8_t m_update_count; /**< Number of Connection Parameter Update messages that has currently been sent. */
jinu 0:6ba9b94b8997 47 static uint16_t m_conn_handle; /**< Current connection handle. */
jinu 0:6ba9b94b8997 48 static ble_gap_conn_params_t m_current_conn_params; /**< Connection parameters received in the most recent Connect event. */
jinu 0:6ba9b94b8997 49 static ble_timer_id_t m_conn_params_timer_id; /**< Connection parameters timer. */
jinu 0:6ba9b94b8997 50
jinu 0:6ba9b94b8997 51 static bool m_change_param = false;
jinu 0:6ba9b94b8997 52
jinu 0:6ba9b94b8997 53
jinu 0:6ba9b94b8997 54 static bool is_conn_params_ok(ble_gap_conn_params_t * p_conn_params)
jinu 0:6ba9b94b8997 55 {
jinu 0:6ba9b94b8997 56 // Check if interval is within the acceptable range.
jinu 0:6ba9b94b8997 57 // NOTE: Using max_conn_interval in the received event data because this contains
jinu 0:6ba9b94b8997 58 // the client's connection interval.
jinu 0:6ba9b94b8997 59 if (
jinu 0:6ba9b94b8997 60 (p_conn_params->max_conn_interval >= m_preferred_conn_params.min_conn_interval)
jinu 0:6ba9b94b8997 61 &&
jinu 0:6ba9b94b8997 62 (p_conn_params->max_conn_interval <= m_preferred_conn_params.max_conn_interval)
jinu 0:6ba9b94b8997 63 )
jinu 0:6ba9b94b8997 64 {
jinu 0:6ba9b94b8997 65 return true;
jinu 0:6ba9b94b8997 66 }
jinu 0:6ba9b94b8997 67 else
jinu 0:6ba9b94b8997 68 {
jinu 0:6ba9b94b8997 69 return false;
jinu 0:6ba9b94b8997 70 }
jinu 0:6ba9b94b8997 71 }
jinu 0:6ba9b94b8997 72
jinu 0:6ba9b94b8997 73
jinu 0:6ba9b94b8997 74 static void update_timeout_handler(void * p_context)
jinu 0:6ba9b94b8997 75 {
jinu 0:6ba9b94b8997 76 if (m_conn_handle != BLE_CONN_HANDLE_INVALID)
jinu 0:6ba9b94b8997 77 {
jinu 0:6ba9b94b8997 78 // Check if we have reached the maximum number of attempts
jinu 0:6ba9b94b8997 79 m_update_count++;
jinu 0:6ba9b94b8997 80 if (m_update_count <= m_conn_params_config.max_conn_params_update_count)
jinu 0:6ba9b94b8997 81 {
jinu 0:6ba9b94b8997 82 uint32_t err_code;
jinu 0:6ba9b94b8997 83
jinu 0:6ba9b94b8997 84 // Parameters are not ok, send connection parameters update request.
jinu 0:6ba9b94b8997 85 err_code = sd_ble_gap_conn_param_update(m_conn_handle, &m_preferred_conn_params);
jinu 0:6ba9b94b8997 86 APP_ERROR_CHECK(err_code);
jinu 0:6ba9b94b8997 87
jinu 0:6ba9b94b8997 88 err_code = blocking_resp_wait();
jinu 0:6ba9b94b8997 89 if ((err_code != NRF_SUCCESS) && (m_conn_params_config.error_handler != NULL))
jinu 0:6ba9b94b8997 90 {
jinu 0:6ba9b94b8997 91 m_conn_params_config.error_handler(err_code);
jinu 0:6ba9b94b8997 92 }
jinu 0:6ba9b94b8997 93 }
jinu 0:6ba9b94b8997 94 else
jinu 0:6ba9b94b8997 95 {
jinu 0:6ba9b94b8997 96 m_update_count = 0;
jinu 0:6ba9b94b8997 97
jinu 0:6ba9b94b8997 98 // Negotiation failed, disconnect automatically if this has been configured.
jinu 0:6ba9b94b8997 99 if (m_conn_params_config.disconnect_on_fail)
jinu 0:6ba9b94b8997 100 {
jinu 0:6ba9b94b8997 101 uint32_t err_code;
jinu 0:6ba9b94b8997 102
jinu 0:6ba9b94b8997 103 err_code = sd_ble_gap_disconnect(m_conn_handle, BLE_HCI_CONN_INTERVAL_UNACCEPTABLE);
jinu 0:6ba9b94b8997 104 APP_ERROR_CHECK(err_code);
jinu 0:6ba9b94b8997 105
jinu 0:6ba9b94b8997 106 err_code = blocking_resp_wait();
jinu 0:6ba9b94b8997 107 if ((err_code != NRF_SUCCESS) && (m_conn_params_config.error_handler != NULL))
jinu 0:6ba9b94b8997 108 {
jinu 0:6ba9b94b8997 109 m_conn_params_config.error_handler(err_code);
jinu 0:6ba9b94b8997 110 }
jinu 0:6ba9b94b8997 111 }
jinu 0:6ba9b94b8997 112
jinu 0:6ba9b94b8997 113 // Notify the application that the procedure has failed
jinu 0:6ba9b94b8997 114 if (m_conn_params_config.evt_handler != NULL)
jinu 0:6ba9b94b8997 115 {
jinu 0:6ba9b94b8997 116 ble_conn_params_evt_t evt;
jinu 0:6ba9b94b8997 117
jinu 0:6ba9b94b8997 118 evt.evt_type = BLE_CONN_PARAMS_EVT_FAILED;
jinu 0:6ba9b94b8997 119 m_conn_params_config.evt_handler(&evt);
jinu 0:6ba9b94b8997 120 }
jinu 0:6ba9b94b8997 121 }
jinu 0:6ba9b94b8997 122 }
jinu 0:6ba9b94b8997 123
jinu 0:6ba9b94b8997 124 }
jinu 0:6ba9b94b8997 125
jinu 0:6ba9b94b8997 126 uint32_t ble_conn_params_init(const ble_conn_params_init_t * p_init)
jinu 0:6ba9b94b8997 127 {
jinu 0:6ba9b94b8997 128 uint32_t err_code;
jinu 0:6ba9b94b8997 129
jinu 0:6ba9b94b8997 130 m_conn_params_config = *p_init;
jinu 0:6ba9b94b8997 131 m_change_param = false;
jinu 0:6ba9b94b8997 132 if (p_init->p_conn_params != NULL)
jinu 0:6ba9b94b8997 133 {
jinu 0:6ba9b94b8997 134 m_preferred_conn_params = *p_init->p_conn_params;
jinu 0:6ba9b94b8997 135
jinu 0:6ba9b94b8997 136 // Set the connection params in stack
jinu 0:6ba9b94b8997 137 err_code = sd_ble_gap_ppcp_set(&m_preferred_conn_params);
jinu 0:6ba9b94b8997 138 APP_ERROR_CHECK(err_code);
jinu 0:6ba9b94b8997 139
jinu 0:6ba9b94b8997 140 err_code = blocking_resp_wait();
jinu 0:6ba9b94b8997 141 if (err_code != NRF_SUCCESS)
jinu 0:6ba9b94b8997 142 {
jinu 0:6ba9b94b8997 143 return err_code;
jinu 0:6ba9b94b8997 144 }
jinu 0:6ba9b94b8997 145 }
jinu 0:6ba9b94b8997 146 else
jinu 0:6ba9b94b8997 147 {
jinu 0:6ba9b94b8997 148 // Fetch the connection params from stack
jinu 0:6ba9b94b8997 149 err_code = sd_ble_gap_ppcp_get(&m_preferred_conn_params);
jinu 0:6ba9b94b8997 150 APP_ERROR_CHECK(err_code);
jinu 0:6ba9b94b8997 151
jinu 0:6ba9b94b8997 152 err_code = blocking_resp_wait();
jinu 0:6ba9b94b8997 153 if (err_code != NRF_SUCCESS)
jinu 0:6ba9b94b8997 154 {
jinu 0:6ba9b94b8997 155 return err_code;
jinu 0:6ba9b94b8997 156 }
jinu 0:6ba9b94b8997 157 }
jinu 0:6ba9b94b8997 158
jinu 0:6ba9b94b8997 159 m_conn_handle = BLE_CONN_HANDLE_INVALID;
jinu 0:6ba9b94b8997 160 m_update_count = 0;
jinu 0:6ba9b94b8997 161
jinu 0:6ba9b94b8997 162 return ble_timer_create(&m_conn_params_timer_id,
jinu 0:6ba9b94b8997 163 BLE_TIMER_MODE_SINGLE_SHOT,
jinu 0:6ba9b94b8997 164 update_timeout_handler);
jinu 0:6ba9b94b8997 165 }
jinu 0:6ba9b94b8997 166
jinu 0:6ba9b94b8997 167
jinu 0:6ba9b94b8997 168 uint32_t ble_conn_params_stop(void)
jinu 0:6ba9b94b8997 169 {
jinu 0:6ba9b94b8997 170 return ble_timer_stop(m_conn_params_timer_id);
jinu 0:6ba9b94b8997 171 }
jinu 0:6ba9b94b8997 172
jinu 0:6ba9b94b8997 173
jinu 0:6ba9b94b8997 174 static void conn_params_negotiation(void)
jinu 0:6ba9b94b8997 175 {
jinu 0:6ba9b94b8997 176 // Start negotiation if the received connection parameters are not acceptable
jinu 0:6ba9b94b8997 177 if (!is_conn_params_ok(&m_current_conn_params))
jinu 0:6ba9b94b8997 178 {
jinu 0:6ba9b94b8997 179 uint32_t err_code;
jinu 0:6ba9b94b8997 180 uint32_t timeout_ms;
jinu 0:6ba9b94b8997 181
jinu 0:6ba9b94b8997 182 if (m_change_param)
jinu 0:6ba9b94b8997 183 {
jinu 0:6ba9b94b8997 184 // Notify the application that the procedure has failed
jinu 0:6ba9b94b8997 185 if (m_conn_params_config.evt_handler != NULL)
jinu 0:6ba9b94b8997 186 {
jinu 0:6ba9b94b8997 187 ble_conn_params_evt_t evt;
jinu 0:6ba9b94b8997 188
jinu 0:6ba9b94b8997 189 evt.evt_type = BLE_CONN_PARAMS_EVT_FAILED;
jinu 0:6ba9b94b8997 190 m_conn_params_config.evt_handler(&evt);
jinu 0:6ba9b94b8997 191 }
jinu 0:6ba9b94b8997 192 }
jinu 0:6ba9b94b8997 193 else
jinu 0:6ba9b94b8997 194 {
jinu 0:6ba9b94b8997 195 if (m_update_count == 0)
jinu 0:6ba9b94b8997 196 {
jinu 0:6ba9b94b8997 197 // First connection parameter update
jinu 0:6ba9b94b8997 198 timeout_ms = m_conn_params_config.first_conn_params_update_delay;
jinu 0:6ba9b94b8997 199 }
jinu 0:6ba9b94b8997 200 else
jinu 0:6ba9b94b8997 201 {
jinu 0:6ba9b94b8997 202 timeout_ms = m_conn_params_config.next_conn_params_update_delay;
jinu 0:6ba9b94b8997 203 }
jinu 0:6ba9b94b8997 204
jinu 0:6ba9b94b8997 205 err_code = ble_timer_start(m_conn_params_timer_id, timeout_ms, NULL);
jinu 0:6ba9b94b8997 206
jinu 0:6ba9b94b8997 207 if ((err_code != NRF_SUCCESS) && (m_conn_params_config.error_handler != NULL))
jinu 0:6ba9b94b8997 208 {
jinu 0:6ba9b94b8997 209 m_conn_params_config.error_handler(err_code);
jinu 0:6ba9b94b8997 210 }
jinu 0:6ba9b94b8997 211 }
jinu 0:6ba9b94b8997 212 }
jinu 0:6ba9b94b8997 213 else
jinu 0:6ba9b94b8997 214 {
jinu 0:6ba9b94b8997 215 // Notify the application that the procedure has succeded
jinu 0:6ba9b94b8997 216 if (m_conn_params_config.evt_handler != NULL)
jinu 0:6ba9b94b8997 217 {
jinu 0:6ba9b94b8997 218 ble_conn_params_evt_t evt;
jinu 0:6ba9b94b8997 219
jinu 0:6ba9b94b8997 220 evt.evt_type = BLE_CONN_PARAMS_EVT_SUCCEEDED;
jinu 0:6ba9b94b8997 221 m_conn_params_config.evt_handler(&evt);
jinu 0:6ba9b94b8997 222 }
jinu 0:6ba9b94b8997 223 }
jinu 0:6ba9b94b8997 224 m_change_param = false;
jinu 0:6ba9b94b8997 225 }
jinu 0:6ba9b94b8997 226
jinu 0:6ba9b94b8997 227
jinu 0:6ba9b94b8997 228 static void on_connect(ble_evt_t * p_ble_evt)
jinu 0:6ba9b94b8997 229 {
jinu 0:6ba9b94b8997 230 // Save connection parameters
jinu 0:6ba9b94b8997 231 m_conn_handle = p_ble_evt->evt.gap_evt.conn_handle;
jinu 0:6ba9b94b8997 232 m_current_conn_params = p_ble_evt->evt.gap_evt.params.connected.conn_params;
jinu 0:6ba9b94b8997 233 m_update_count = 0; // Connection parameter negotiation should re-start every connection
jinu 0:6ba9b94b8997 234
jinu 0:6ba9b94b8997 235 // Check if we shall handle negotiation on connect
jinu 0:6ba9b94b8997 236 if (m_conn_params_config.start_on_notify_cccd_handle == BLE_GATT_HANDLE_INVALID)
jinu 0:6ba9b94b8997 237 {
jinu 0:6ba9b94b8997 238 conn_params_negotiation();
jinu 0:6ba9b94b8997 239 }
jinu 0:6ba9b94b8997 240 }
jinu 0:6ba9b94b8997 241
jinu 0:6ba9b94b8997 242
jinu 0:6ba9b94b8997 243 static void on_disconnect(ble_evt_t * p_ble_evt)
jinu 0:6ba9b94b8997 244 {
jinu 0:6ba9b94b8997 245 uint32_t err_code;
jinu 0:6ba9b94b8997 246
jinu 0:6ba9b94b8997 247 m_conn_handle = BLE_CONN_HANDLE_INVALID;
jinu 0:6ba9b94b8997 248
jinu 0:6ba9b94b8997 249 // Stop timer if running
jinu 0:6ba9b94b8997 250 m_update_count = 0; // Connection parameters updates should happen during every connection
jinu 0:6ba9b94b8997 251
jinu 0:6ba9b94b8997 252 err_code = ble_timer_stop(m_conn_params_timer_id);
jinu 0:6ba9b94b8997 253
jinu 0:6ba9b94b8997 254 if ((err_code != NRF_SUCCESS) && (m_conn_params_config.error_handler != NULL))
jinu 0:6ba9b94b8997 255 {
jinu 0:6ba9b94b8997 256 m_conn_params_config.error_handler(err_code);
jinu 0:6ba9b94b8997 257 }
jinu 0:6ba9b94b8997 258 }
jinu 0:6ba9b94b8997 259
jinu 0:6ba9b94b8997 260
jinu 0:6ba9b94b8997 261 static void on_write(ble_evt_t * p_ble_evt)
jinu 0:6ba9b94b8997 262 {
jinu 0:6ba9b94b8997 263 ble_gatts_evt_write_t * p_evt_write = &p_ble_evt->evt.gatts_evt.params.write;
jinu 0:6ba9b94b8997 264
jinu 0:6ba9b94b8997 265 // Check if this the correct CCCD
jinu 0:6ba9b94b8997 266 if (
jinu 0:6ba9b94b8997 267 (p_evt_write->handle == m_conn_params_config.start_on_notify_cccd_handle)
jinu 0:6ba9b94b8997 268 &&
jinu 0:6ba9b94b8997 269 (p_evt_write->len == 2)
jinu 0:6ba9b94b8997 270 )
jinu 0:6ba9b94b8997 271 {
jinu 0:6ba9b94b8997 272 // Check if this is a 'start notification'
jinu 0:6ba9b94b8997 273 if (ble_srv_is_notification_enabled(p_evt_write->data))
jinu 0:6ba9b94b8997 274 {
jinu 0:6ba9b94b8997 275 // Do connection parameter negotiation if necessary
jinu 0:6ba9b94b8997 276 conn_params_negotiation();
jinu 0:6ba9b94b8997 277 }
jinu 0:6ba9b94b8997 278 else
jinu 0:6ba9b94b8997 279 {
jinu 0:6ba9b94b8997 280 uint32_t err_code;
jinu 0:6ba9b94b8997 281
jinu 0:6ba9b94b8997 282 // Stop timer if running
jinu 0:6ba9b94b8997 283 err_code = ble_timer_stop(m_conn_params_timer_id);
jinu 0:6ba9b94b8997 284
jinu 0:6ba9b94b8997 285 if ((err_code != NRF_SUCCESS) && (m_conn_params_config.error_handler != NULL))
jinu 0:6ba9b94b8997 286 {
jinu 0:6ba9b94b8997 287 m_conn_params_config.error_handler(err_code);
jinu 0:6ba9b94b8997 288 }
jinu 0:6ba9b94b8997 289 }
jinu 0:6ba9b94b8997 290 }
jinu 0:6ba9b94b8997 291 }
jinu 0:6ba9b94b8997 292
jinu 0:6ba9b94b8997 293
jinu 0:6ba9b94b8997 294 static void on_conn_params_update(ble_evt_t * p_ble_evt)
jinu 0:6ba9b94b8997 295 {
jinu 0:6ba9b94b8997 296 // Copy the parameters
jinu 0:6ba9b94b8997 297 m_current_conn_params = p_ble_evt->evt.gap_evt.params.conn_param_update.conn_params;
jinu 0:6ba9b94b8997 298
jinu 0:6ba9b94b8997 299 conn_params_negotiation();
jinu 0:6ba9b94b8997 300 }
jinu 0:6ba9b94b8997 301
jinu 0:6ba9b94b8997 302
jinu 0:6ba9b94b8997 303 void ble_conn_params_on_ble_evt(ble_evt_t * p_ble_evt)
jinu 0:6ba9b94b8997 304 {
jinu 0:6ba9b94b8997 305 switch (p_ble_evt->header.evt_id)
jinu 0:6ba9b94b8997 306 {
jinu 0:6ba9b94b8997 307 case BLE_GAP_EVT_CONNECTED:
jinu 0:6ba9b94b8997 308 on_connect(p_ble_evt);
jinu 0:6ba9b94b8997 309 break;
jinu 0:6ba9b94b8997 310
jinu 0:6ba9b94b8997 311 case BLE_GAP_EVT_DISCONNECTED:
jinu 0:6ba9b94b8997 312 on_disconnect(p_ble_evt);
jinu 0:6ba9b94b8997 313 break;
jinu 0:6ba9b94b8997 314
jinu 0:6ba9b94b8997 315 case BLE_GATTS_EVT_WRITE:
jinu 0:6ba9b94b8997 316 on_write(p_ble_evt);
jinu 0:6ba9b94b8997 317 break;
jinu 0:6ba9b94b8997 318
jinu 0:6ba9b94b8997 319 case BLE_GAP_EVT_CONN_PARAM_UPDATE:
jinu 0:6ba9b94b8997 320 on_conn_params_update(p_ble_evt);
jinu 0:6ba9b94b8997 321 break;
jinu 0:6ba9b94b8997 322
jinu 0:6ba9b94b8997 323 default:
jinu 0:6ba9b94b8997 324 // No implementation needed.
jinu 0:6ba9b94b8997 325 break;
jinu 0:6ba9b94b8997 326 }
jinu 0:6ba9b94b8997 327 }
jinu 0:6ba9b94b8997 328
jinu 0:6ba9b94b8997 329 uint32_t ble_conn_params_change_conn_params(ble_gap_conn_params_t *new_params)
jinu 0:6ba9b94b8997 330 {
jinu 0:6ba9b94b8997 331 uint32_t err_code;
jinu 0:6ba9b94b8997 332
jinu 0:6ba9b94b8997 333 m_preferred_conn_params = *new_params;
jinu 0:6ba9b94b8997 334 // Set the connection params in stack
jinu 0:6ba9b94b8997 335 err_code = sd_ble_gap_ppcp_set(&m_preferred_conn_params);
jinu 0:6ba9b94b8997 336 APP_ERROR_CHECK(err_code);
jinu 0:6ba9b94b8997 337
jinu 0:6ba9b94b8997 338 err_code = blocking_resp_wait();
jinu 0:6ba9b94b8997 339 if (err_code == NRF_SUCCESS)
jinu 0:6ba9b94b8997 340 {
jinu 0:6ba9b94b8997 341 if (!is_conn_params_ok(&m_current_conn_params))
jinu 0:6ba9b94b8997 342 {
jinu 0:6ba9b94b8997 343 m_change_param = true;
jinu 0:6ba9b94b8997 344 err_code = sd_ble_gap_conn_param_update(m_conn_handle, &m_preferred_conn_params);
jinu 0:6ba9b94b8997 345 APP_ERROR_CHECK(err_code);
jinu 0:6ba9b94b8997 346
jinu 0:6ba9b94b8997 347 err_code = blocking_resp_wait();
jinu 0:6ba9b94b8997 348 m_update_count = 1;
jinu 0:6ba9b94b8997 349 }
jinu 0:6ba9b94b8997 350 else
jinu 0:6ba9b94b8997 351 {
jinu 0:6ba9b94b8997 352 // Notify the application that the procedure has succeded
jinu 0:6ba9b94b8997 353 if (m_conn_params_config.evt_handler != NULL)
jinu 0:6ba9b94b8997 354 {
jinu 0:6ba9b94b8997 355 ble_conn_params_evt_t evt;
jinu 0:6ba9b94b8997 356
jinu 0:6ba9b94b8997 357 evt.evt_type = BLE_CONN_PARAMS_EVT_SUCCEEDED;
jinu 0:6ba9b94b8997 358 m_conn_params_config.evt_handler(&evt);
jinu 0:6ba9b94b8997 359 }
jinu 0:6ba9b94b8997 360 err_code = NRF_SUCCESS;
jinu 0:6ba9b94b8997 361 }
jinu 0:6ba9b94b8997 362 }
jinu 0:6ba9b94b8997 363 return err_code;
jinu 0:6ba9b94b8997 364 }
jinu 0:6ba9b94b8997 365