Cefn Hoile / nRF51822

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   nrf51-sdk

Dependents:   microbit-dal

Fork of nRF51822 by Lancaster University

nordic-sdk/components/ble/common/ble_advdata.c@343:6675661fa600, 2015-06-19 (annotated)

Committer:
rgrover1
Date:
Fri Jun 19 15:55:34 2015 +0100
Revision:
343:6675661fa600
Parent:
112:737b08b3b995
Child:
345:dfde56236c36
Synchronized with git rev 6d1bf116

Author: Rohit Grover

fix #1: update license headers for all sources obtained from nordic-SDK using a new template obtained from Nordic.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
rgrover1 343:6675661fa600 1 /*
rgrover1 343:6675661fa600 2 * Copyright (c) Nordic Semiconductor ASA
rgrover1 343:6675661fa600 3 * All rights reserved.
rgrover1 343:6675661fa600 4 *
rgrover1 343:6675661fa600 5 * Redistribution and use in source and binary forms, with or without modification,
rgrover1 343:6675661fa600 6 * are permitted provided that the following conditions are met:
rgrover1 343:6675661fa600 7 *
rgrover1 343:6675661fa600 8 * 1. Redistributions of source code must retain the above copyright notice, this
rgrover1 343:6675661fa600 9 * list of conditions and the following disclaimer.
rgrover1 343:6675661fa600 10 *
rgrover1 343:6675661fa600 11 * 2. Redistributions in binary form must reproduce the above copyright notice, this
rgrover1 343:6675661fa600 12 * list of conditions and the following disclaimer in the documentation and/or
rgrover1 343:6675661fa600 13 * other materials provided with the distribution.
rgrover1 343:6675661fa600 14 *
rgrover1 343:6675661fa600 15 * 3. Neither the name of Nordic Semiconductor ASA nor the names of other
rgrover1 343:6675661fa600 16 * contributors to this software may be used to endorse or promote products
rgrover1 343:6675661fa600 17 * derived from this software without specific prior written permission.
rgrover1 343:6675661fa600 18 *
rgrover1 343:6675661fa600 19 *
rgrover1 343:6675661fa600 20 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
rgrover1 343:6675661fa600 21 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
rgrover1 343:6675661fa600 22 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
rgrover1 343:6675661fa600 23 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR
rgrover1 343:6675661fa600 24 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
rgrover1 343:6675661fa600 25 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
rgrover1 343:6675661fa600 26 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
rgrover1 343:6675661fa600 27 * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
rgrover1 343:6675661fa600 28 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
rgrover1 343:6675661fa600 29 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
rgrover1 343:6675661fa600 30 *
rgrover1 343:6675661fa600 31 */
rgrover1 343:6675661fa600 32
rgrover1 343:6675661fa600 33 #include "ble_advdata.h"
rgrover1 343:6675661fa600 34 #include "nordic_common.h"
rgrover1 343:6675661fa600 35 #include "nrf_error.h"
rgrover1 343:6675661fa600 36 #include "ble_gap.h"
rgrover1 343:6675661fa600 37 #include "ble_srv_common.h"
rgrover1 343:6675661fa600 38 #include "app_util.h"
rgrover1 343:6675661fa600 39
rgrover1 343:6675661fa600 40
rgrover1 343:6675661fa600 41 // Offset from where advertisement data other than flags information can start.
rgrover1 343:6675661fa600 42 #define ADV_FLAG_OFFSET 2
rgrover1 343:6675661fa600 43
rgrover1 343:6675661fa600 44 // Offset for Advertising Data.
rgrover1 343:6675661fa600 45 // Offset is 2 as each Advertising Data contain 1 octet of Adveritising Data Type and
rgrover1 343:6675661fa600 46 // one octet Advertising Data Length.
rgrover1 343:6675661fa600 47 #define ADV_DATA_OFFSET 2
rgrover1 343:6675661fa600 48
rgrover1 343:6675661fa600 49 // NOTE: For now, Security Manager TK Value and Security Manager Out of Band Flags (OOB) are omitted
rgrover1 343:6675661fa600 50 // from the advertising data.
rgrover1 343:6675661fa600 51
rgrover1 343:6675661fa600 52
rgrover1 343:6675661fa600 53 static uint32_t name_encode(const ble_advdata_t * p_advdata,
rgrover1 343:6675661fa600 54 uint8_t * p_encoded_data,
rgrover1 343:6675661fa600 55 uint8_t * p_len)
rgrover1 343:6675661fa600 56 {
rgrover1 343:6675661fa600 57 uint32_t err_code;
rgrover1 343:6675661fa600 58 uint16_t rem_adv_data_len;
rgrover1 343:6675661fa600 59 uint16_t actual_length;
rgrover1 343:6675661fa600 60 uint8_t adv_data_format;
rgrover1 343:6675661fa600 61 uint8_t adv_offset;
rgrover1 343:6675661fa600 62
rgrover1 343:6675661fa600 63 adv_offset = *p_len;
rgrover1 343:6675661fa600 64
rgrover1 343:6675661fa600 65
rgrover1 343:6675661fa600 66 // Check for buffer overflow.
rgrover1 343:6675661fa600 67 if ((adv_offset + ADV_DATA_OFFSET > BLE_GAP_ADV_MAX_SIZE) ||
rgrover1 343:6675661fa600 68 ((p_advdata->short_name_len + ADV_DATA_OFFSET) > BLE_GAP_ADV_MAX_SIZE))
rgrover1 343:6675661fa600 69 {
rgrover1 343:6675661fa600 70 return NRF_ERROR_DATA_SIZE;
rgrover1 343:6675661fa600 71 }
rgrover1 343:6675661fa600 72 actual_length = rem_adv_data_len = (BLE_GAP_ADV_MAX_SIZE - adv_offset - ADV_FLAG_OFFSET);
rgrover1 343:6675661fa600 73
rgrover1 343:6675661fa600 74 // Get GAP device name and length
rgrover1 343:6675661fa600 75 err_code = sd_ble_gap_device_name_get(&p_encoded_data[adv_offset + ADV_DATA_OFFSET],
rgrover1 343:6675661fa600 76 &actual_length);
rgrover1 343:6675661fa600 77 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 78 {
rgrover1 343:6675661fa600 79 return err_code;
rgrover1 343:6675661fa600 80 }
rgrover1 343:6675661fa600 81
rgrover1 343:6675661fa600 82 // Check if device internd to use short name and it can fit available data size.
rgrover1 343:6675661fa600 83 if ((p_advdata->name_type == BLE_ADVDATA_FULL_NAME) && (actual_length <= rem_adv_data_len))
rgrover1 343:6675661fa600 84 {
rgrover1 343:6675661fa600 85 // Complete device name can fit, setting Complete Name in Adv Data.
rgrover1 343:6675661fa600 86 adv_data_format = BLE_GAP_AD_TYPE_COMPLETE_LOCAL_NAME;
rgrover1 343:6675661fa600 87 rem_adv_data_len = actual_length;
rgrover1 343:6675661fa600 88 }
rgrover1 343:6675661fa600 89 else
rgrover1 343:6675661fa600 90 {
rgrover1 343:6675661fa600 91 // Else short name needs to be used. Or application has requested use of short name.
rgrover1 343:6675661fa600 92 adv_data_format = BLE_GAP_AD_TYPE_SHORT_LOCAL_NAME;
rgrover1 343:6675661fa600 93
rgrover1 343:6675661fa600 94 // If application has set a preference on the short name size, it needs to be considered,
rgrover1 343:6675661fa600 95 // else fit what can be fit.
rgrover1 343:6675661fa600 96 if ((p_advdata->short_name_len != 0) && (p_advdata->short_name_len <= rem_adv_data_len))
rgrover1 343:6675661fa600 97 {
rgrover1 343:6675661fa600 98 // Short name fits available size.
rgrover1 343:6675661fa600 99 rem_adv_data_len = p_advdata->short_name_len;
rgrover1 343:6675661fa600 100 }
rgrover1 343:6675661fa600 101 // Else whatever can fit the data buffer will be packed.
rgrover1 343:6675661fa600 102 else
rgrover1 343:6675661fa600 103 {
rgrover1 343:6675661fa600 104 rem_adv_data_len = actual_length;
rgrover1 343:6675661fa600 105 }
rgrover1 343:6675661fa600 106 }
rgrover1 343:6675661fa600 107
rgrover1 343:6675661fa600 108 // Complete name field in encoded data.
rgrover1 343:6675661fa600 109 p_encoded_data[adv_offset++] = rem_adv_data_len + 1;
rgrover1 343:6675661fa600 110 p_encoded_data[adv_offset++] = adv_data_format;
rgrover1 343:6675661fa600 111 (*p_len) += (rem_adv_data_len + ADV_DATA_OFFSET);
rgrover1 343:6675661fa600 112
rgrover1 343:6675661fa600 113 return NRF_SUCCESS;
rgrover1 343:6675661fa600 114 }
rgrover1 343:6675661fa600 115
rgrover1 343:6675661fa600 116
rgrover1 343:6675661fa600 117 static uint32_t appearance_encode(uint8_t * p_encoded_data, uint8_t * p_len)
rgrover1 343:6675661fa600 118 {
rgrover1 343:6675661fa600 119 uint32_t err_code;
rgrover1 343:6675661fa600 120 uint16_t appearance;
rgrover1 343:6675661fa600 121
rgrover1 343:6675661fa600 122 // Check for buffer overflow.
rgrover1 343:6675661fa600 123 if ((*p_len) + 4 > BLE_GAP_ADV_MAX_SIZE)
rgrover1 343:6675661fa600 124 {
rgrover1 343:6675661fa600 125 return NRF_ERROR_DATA_SIZE;
rgrover1 343:6675661fa600 126 }
rgrover1 343:6675661fa600 127
rgrover1 343:6675661fa600 128 // Get GAP appearance field.
rgrover1 343:6675661fa600 129 err_code = sd_ble_gap_appearance_get(&appearance);
rgrover1 343:6675661fa600 130 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 131 {
rgrover1 343:6675661fa600 132 return err_code;
rgrover1 343:6675661fa600 133 }
rgrover1 343:6675661fa600 134
rgrover1 343:6675661fa600 135 // Encode Length, AD Type and Appearance.
rgrover1 343:6675661fa600 136 p_encoded_data[(*p_len)++] = 3;
rgrover1 343:6675661fa600 137 p_encoded_data[(*p_len)++] = BLE_GAP_AD_TYPE_APPEARANCE;
rgrover1 343:6675661fa600 138
rgrover1 343:6675661fa600 139 (*p_len) += uint16_encode(appearance, &p_encoded_data[*p_len]);
rgrover1 343:6675661fa600 140
rgrover1 343:6675661fa600 141 return NRF_SUCCESS;
rgrover1 343:6675661fa600 142 }
rgrover1 343:6675661fa600 143
rgrover1 343:6675661fa600 144
rgrover1 343:6675661fa600 145 static uint32_t tx_power_level_encode(int8_t tx_power_level,
rgrover1 343:6675661fa600 146 uint8_t * p_encoded_data,
rgrover1 343:6675661fa600 147 uint8_t * p_len)
rgrover1 343:6675661fa600 148 {
rgrover1 343:6675661fa600 149 // Check for buffer overflow.
rgrover1 343:6675661fa600 150 if ((*p_len) + 3 > BLE_GAP_ADV_MAX_SIZE)
rgrover1 343:6675661fa600 151 {
rgrover1 343:6675661fa600 152 return NRF_ERROR_DATA_SIZE;
rgrover1 343:6675661fa600 153 }
rgrover1 343:6675661fa600 154
rgrover1 343:6675661fa600 155 // Encode TX Power Level.
rgrover1 343:6675661fa600 156 p_encoded_data[(*p_len)++] = 2;
rgrover1 343:6675661fa600 157 p_encoded_data[(*p_len)++] = BLE_GAP_AD_TYPE_TX_POWER_LEVEL;
rgrover1 343:6675661fa600 158 p_encoded_data[(*p_len)++] = (uint8_t)tx_power_level;
rgrover1 343:6675661fa600 159
rgrover1 343:6675661fa600 160 return NRF_SUCCESS;
rgrover1 343:6675661fa600 161 }
rgrover1 343:6675661fa600 162
rgrover1 343:6675661fa600 163
rgrover1 343:6675661fa600 164 static uint32_t uuid_list_sized_encode(const ble_advdata_uuid_list_t * p_uuid_list,
rgrover1 343:6675661fa600 165 uint8_t adv_type,
rgrover1 343:6675661fa600 166 uint8_t uuid_size,
rgrover1 343:6675661fa600 167 uint8_t * p_encoded_data,
rgrover1 343:6675661fa600 168 uint8_t * p_len)
rgrover1 343:6675661fa600 169 {
rgrover1 343:6675661fa600 170 int i;
rgrover1 343:6675661fa600 171 bool is_heading_written = false;
rgrover1 343:6675661fa600 172 uint8_t start_pos = *p_len;
rgrover1 343:6675661fa600 173
rgrover1 343:6675661fa600 174 for (i = 0; i < p_uuid_list->uuid_cnt; i++)
rgrover1 343:6675661fa600 175 {
rgrover1 343:6675661fa600 176 uint32_t err_code;
rgrover1 343:6675661fa600 177 uint8_t encoded_size;
rgrover1 343:6675661fa600 178 ble_uuid_t uuid = p_uuid_list->p_uuids[i];
rgrover1 343:6675661fa600 179
rgrover1 343:6675661fa600 180 // Find encoded uuid size.
rgrover1 343:6675661fa600 181 err_code = sd_ble_uuid_encode(&uuid, &encoded_size, NULL);
rgrover1 343:6675661fa600 182 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 183 {
rgrover1 343:6675661fa600 184 return err_code;
rgrover1 343:6675661fa600 185 }
rgrover1 343:6675661fa600 186
rgrover1 343:6675661fa600 187 // Check size.
rgrover1 343:6675661fa600 188 if (encoded_size == uuid_size)
rgrover1 343:6675661fa600 189 {
rgrover1 343:6675661fa600 190 uint8_t heading_bytes = (is_heading_written) ? 0 : 2;
rgrover1 343:6675661fa600 191
rgrover1 343:6675661fa600 192 // Check for buffer overflow
rgrover1 343:6675661fa600 193 if (*p_len + encoded_size + heading_bytes > BLE_GAP_ADV_MAX_SIZE)
rgrover1 343:6675661fa600 194 {
rgrover1 343:6675661fa600 195 return NRF_ERROR_DATA_SIZE;
rgrover1 343:6675661fa600 196 }
rgrover1 343:6675661fa600 197
rgrover1 343:6675661fa600 198 if (!is_heading_written)
rgrover1 343:6675661fa600 199 {
rgrover1 343:6675661fa600 200 // Write AD structure heading.
rgrover1 343:6675661fa600 201 (*p_len)++;
rgrover1 343:6675661fa600 202 p_encoded_data[(*p_len)++] = adv_type;
rgrover1 343:6675661fa600 203 is_heading_written = true;
rgrover1 343:6675661fa600 204 }
rgrover1 343:6675661fa600 205
rgrover1 343:6675661fa600 206 // Write UUID.
rgrover1 343:6675661fa600 207 err_code = sd_ble_uuid_encode(&uuid, &encoded_size, &p_encoded_data[*p_len]);
rgrover1 343:6675661fa600 208 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 209 {
rgrover1 343:6675661fa600 210 return err_code;
rgrover1 343:6675661fa600 211 }
rgrover1 343:6675661fa600 212 (*p_len) += encoded_size;
rgrover1 343:6675661fa600 213 }
rgrover1 343:6675661fa600 214 }
rgrover1 343:6675661fa600 215
rgrover1 343:6675661fa600 216 if (is_heading_written)
rgrover1 343:6675661fa600 217 {
rgrover1 343:6675661fa600 218 // Write length.
rgrover1 343:6675661fa600 219 p_encoded_data[start_pos] = (*p_len) - (start_pos + 1);
rgrover1 343:6675661fa600 220 }
rgrover1 343:6675661fa600 221
rgrover1 343:6675661fa600 222 return NRF_SUCCESS;
rgrover1 343:6675661fa600 223 }
rgrover1 343:6675661fa600 224
rgrover1 343:6675661fa600 225
rgrover1 343:6675661fa600 226 static uint32_t uuid_list_encode(const ble_advdata_uuid_list_t * p_uuid_list,
rgrover1 343:6675661fa600 227 uint8_t adv_type_16,
rgrover1 343:6675661fa600 228 uint8_t adv_type_128,
rgrover1 343:6675661fa600 229 uint8_t * p_encoded_data,
rgrover1 343:6675661fa600 230 uint8_t * p_len)
rgrover1 343:6675661fa600 231 {
rgrover1 343:6675661fa600 232 uint32_t err_code;
rgrover1 343:6675661fa600 233
rgrover1 343:6675661fa600 234 // Encode 16 bit UUIDs.
rgrover1 343:6675661fa600 235 err_code = uuid_list_sized_encode(p_uuid_list,
rgrover1 343:6675661fa600 236 adv_type_16,
rgrover1 343:6675661fa600 237 sizeof(uint16_le_t),
rgrover1 343:6675661fa600 238 p_encoded_data,
rgrover1 343:6675661fa600 239 p_len);
rgrover1 343:6675661fa600 240 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 241 {
rgrover1 343:6675661fa600 242 return err_code;
rgrover1 343:6675661fa600 243 }
rgrover1 343:6675661fa600 244
rgrover1 343:6675661fa600 245 // Encode 128 bit UUIDs.
rgrover1 343:6675661fa600 246 err_code = uuid_list_sized_encode(p_uuid_list,
rgrover1 343:6675661fa600 247 adv_type_128,
rgrover1 343:6675661fa600 248 sizeof(ble_uuid128_t),
rgrover1 343:6675661fa600 249 p_encoded_data,
rgrover1 343:6675661fa600 250 p_len);
rgrover1 343:6675661fa600 251 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 252 {
rgrover1 343:6675661fa600 253 return err_code;
rgrover1 343:6675661fa600 254 }
rgrover1 343:6675661fa600 255
rgrover1 343:6675661fa600 256 return NRF_SUCCESS;
rgrover1 343:6675661fa600 257 }
rgrover1 343:6675661fa600 258
rgrover1 343:6675661fa600 259
rgrover1 343:6675661fa600 260 static uint32_t conn_int_check(const ble_advdata_conn_int_t *p_conn_int)
rgrover1 343:6675661fa600 261 {
rgrover1 343:6675661fa600 262 // Check Minimum Connection Interval.
rgrover1 343:6675661fa600 263 if ((p_conn_int->min_conn_interval < 0x0006) ||
rgrover1 343:6675661fa600 264 (
rgrover1 343:6675661fa600 265 (p_conn_int->min_conn_interval > 0x0c80) &&
rgrover1 343:6675661fa600 266 (p_conn_int->min_conn_interval != 0xffff)
rgrover1 343:6675661fa600 267 )
rgrover1 343:6675661fa600 268 )
rgrover1 343:6675661fa600 269 {
rgrover1 343:6675661fa600 270 return NRF_ERROR_INVALID_PARAM;
rgrover1 343:6675661fa600 271 }
rgrover1 343:6675661fa600 272
rgrover1 343:6675661fa600 273 // Check Maximum Connection Interval.
rgrover1 343:6675661fa600 274 if ((p_conn_int->max_conn_interval < 0x0006) ||
rgrover1 343:6675661fa600 275 (
rgrover1 343:6675661fa600 276 (p_conn_int->max_conn_interval > 0x0c80) &&
rgrover1 343:6675661fa600 277 (p_conn_int->max_conn_interval != 0xffff)
rgrover1 343:6675661fa600 278 )
rgrover1 343:6675661fa600 279 )
rgrover1 343:6675661fa600 280 {
rgrover1 343:6675661fa600 281 return NRF_ERROR_INVALID_PARAM;
rgrover1 343:6675661fa600 282 }
rgrover1 343:6675661fa600 283
rgrover1 343:6675661fa600 284 // Make sure Minimum Connection Interval is not bigger than Maximum Connection Interval.
rgrover1 343:6675661fa600 285 if ((p_conn_int->min_conn_interval != 0xffff) &&
rgrover1 343:6675661fa600 286 (p_conn_int->max_conn_interval != 0xffff) &&
rgrover1 343:6675661fa600 287 (p_conn_int->min_conn_interval > p_conn_int->max_conn_interval)
rgrover1 343:6675661fa600 288 )
rgrover1 343:6675661fa600 289 {
rgrover1 343:6675661fa600 290 return NRF_ERROR_INVALID_PARAM;
rgrover1 343:6675661fa600 291 }
rgrover1 343:6675661fa600 292
rgrover1 343:6675661fa600 293 return NRF_SUCCESS;
rgrover1 343:6675661fa600 294 }
rgrover1 343:6675661fa600 295
rgrover1 343:6675661fa600 296
rgrover1 343:6675661fa600 297 static uint32_t conn_int_encode(const ble_advdata_conn_int_t * p_conn_int,
rgrover1 343:6675661fa600 298 uint8_t * p_encoded_data,
rgrover1 343:6675661fa600 299 uint8_t * p_len)
rgrover1 343:6675661fa600 300 {
rgrover1 343:6675661fa600 301 uint32_t err_code;
rgrover1 343:6675661fa600 302
rgrover1 343:6675661fa600 303 // Check for buffer overflow.
rgrover1 343:6675661fa600 304 if ((*p_len) + ADV_DATA_OFFSET + 2 * sizeof(uint16_le_t) > BLE_GAP_ADV_MAX_SIZE)
rgrover1 343:6675661fa600 305 {
rgrover1 343:6675661fa600 306 return NRF_ERROR_DATA_SIZE;
rgrover1 343:6675661fa600 307 }
rgrover1 343:6675661fa600 308
rgrover1 343:6675661fa600 309 // Check parameters.
rgrover1 343:6675661fa600 310 err_code = conn_int_check(p_conn_int);
rgrover1 343:6675661fa600 311 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 312 {
rgrover1 343:6675661fa600 313 return err_code;
rgrover1 343:6675661fa600 314 }
rgrover1 343:6675661fa600 315
rgrover1 343:6675661fa600 316 // Encode Length and AD Type.
rgrover1 343:6675661fa600 317 p_encoded_data[(*p_len)++] = 1 + 2 * sizeof(uint16_le_t);
rgrover1 343:6675661fa600 318 p_encoded_data[(*p_len)++] = BLE_GAP_AD_TYPE_SLAVE_CONNECTION_INTERVAL_RANGE;
rgrover1 343:6675661fa600 319
rgrover1 343:6675661fa600 320 // Encode Minimum and Maximum Connection Intervals.
rgrover1 343:6675661fa600 321 (*p_len) += uint16_encode(p_conn_int->min_conn_interval, &p_encoded_data[*p_len]);
rgrover1 343:6675661fa600 322 (*p_len) += uint16_encode(p_conn_int->max_conn_interval, &p_encoded_data[*p_len]);
rgrover1 343:6675661fa600 323
rgrover1 343:6675661fa600 324 return NRF_SUCCESS;
rgrover1 343:6675661fa600 325 }
rgrover1 343:6675661fa600 326
rgrover1 343:6675661fa600 327
rgrover1 343:6675661fa600 328 static uint32_t manuf_specific_data_encode(const ble_advdata_manuf_data_t * p_manuf_sp_data,
rgrover1 343:6675661fa600 329 uint8_t * p_encoded_data,
rgrover1 343:6675661fa600 330 uint8_t * p_len)
rgrover1 343:6675661fa600 331 {
rgrover1 343:6675661fa600 332 uint8_t data_size = sizeof(uint16_le_t) + p_manuf_sp_data->data.size;
rgrover1 343:6675661fa600 333
rgrover1 343:6675661fa600 334 // Check for buffer overflow.
rgrover1 343:6675661fa600 335 if ((*p_len) + ADV_DATA_OFFSET + data_size > BLE_GAP_ADV_MAX_SIZE)
rgrover1 343:6675661fa600 336 {
rgrover1 343:6675661fa600 337 return NRF_ERROR_DATA_SIZE;
rgrover1 343:6675661fa600 338 }
rgrover1 343:6675661fa600 339
rgrover1 343:6675661fa600 340 // Encode Length and AD Type.
rgrover1 343:6675661fa600 341 p_encoded_data[(*p_len)++] = 1 + data_size;
rgrover1 343:6675661fa600 342 p_encoded_data[(*p_len)++] = BLE_GAP_AD_TYPE_MANUFACTURER_SPECIFIC_DATA;
rgrover1 343:6675661fa600 343
rgrover1 343:6675661fa600 344 // Encode Company Identifier.
rgrover1 343:6675661fa600 345 (*p_len) += uint16_encode(p_manuf_sp_data->company_identifier, &p_encoded_data[*p_len]);
rgrover1 343:6675661fa600 346
rgrover1 343:6675661fa600 347 // Encode additional manufacturer specific data.
rgrover1 343:6675661fa600 348 if (p_manuf_sp_data->data.size > 0)
rgrover1 343:6675661fa600 349 {
rgrover1 343:6675661fa600 350 if (p_manuf_sp_data->data.p_data == NULL)
rgrover1 343:6675661fa600 351 {
rgrover1 343:6675661fa600 352 return NRF_ERROR_INVALID_PARAM;
rgrover1 343:6675661fa600 353 }
rgrover1 343:6675661fa600 354 memcpy(&p_encoded_data[*p_len], p_manuf_sp_data->data.p_data, p_manuf_sp_data->data.size);
rgrover1 343:6675661fa600 355 (*p_len) += p_manuf_sp_data->data.size;
rgrover1 343:6675661fa600 356 }
rgrover1 343:6675661fa600 357
rgrover1 343:6675661fa600 358 return NRF_SUCCESS;
rgrover1 343:6675661fa600 359 }
rgrover1 343:6675661fa600 360
rgrover1 343:6675661fa600 361
rgrover1 343:6675661fa600 362 static uint32_t service_data_encode(const ble_advdata_t * p_advdata,
rgrover1 343:6675661fa600 363 uint8_t * p_encoded_data,
rgrover1 343:6675661fa600 364 uint8_t * p_len)
rgrover1 343:6675661fa600 365 {
rgrover1 343:6675661fa600 366 uint8_t i;
rgrover1 343:6675661fa600 367
rgrover1 343:6675661fa600 368 // Check parameter consistency.
rgrover1 343:6675661fa600 369 if (p_advdata->p_service_data_array == NULL)
rgrover1 343:6675661fa600 370 {
rgrover1 343:6675661fa600 371 return NRF_ERROR_INVALID_PARAM;
rgrover1 343:6675661fa600 372 }
rgrover1 343:6675661fa600 373
rgrover1 343:6675661fa600 374 for (i = 0; i < p_advdata->service_data_count; i++)
rgrover1 343:6675661fa600 375 {
rgrover1 343:6675661fa600 376 ble_advdata_service_data_t * p_service_data;
rgrover1 343:6675661fa600 377 uint8_t data_size;
rgrover1 343:6675661fa600 378
rgrover1 343:6675661fa600 379 p_service_data = &p_advdata->p_service_data_array[i];
rgrover1 343:6675661fa600 380 data_size = sizeof(uint16_le_t) + p_service_data->data.size;
rgrover1 343:6675661fa600 381
rgrover1 343:6675661fa600 382 // Encode Length and AD Type.
rgrover1 343:6675661fa600 383 p_encoded_data[(*p_len)++] = 1 + data_size;
rgrover1 343:6675661fa600 384 p_encoded_data[(*p_len)++] = BLE_GAP_AD_TYPE_SERVICE_DATA;
rgrover1 343:6675661fa600 385
rgrover1 343:6675661fa600 386 // Encode service UUID.
rgrover1 343:6675661fa600 387 (*p_len) += uint16_encode(p_service_data->service_uuid, &p_encoded_data[*p_len]);
rgrover1 343:6675661fa600 388
rgrover1 343:6675661fa600 389 // Encode additional service data.
rgrover1 343:6675661fa600 390 if (p_service_data->data.size > 0)
rgrover1 343:6675661fa600 391 {
rgrover1 343:6675661fa600 392 if (p_service_data->data.p_data == NULL)
rgrover1 343:6675661fa600 393 {
rgrover1 343:6675661fa600 394 return NRF_ERROR_INVALID_PARAM;
rgrover1 343:6675661fa600 395 }
rgrover1 343:6675661fa600 396 memcpy(&p_encoded_data[*p_len], p_service_data->data.p_data, p_service_data->data.size);
rgrover1 343:6675661fa600 397 (*p_len) += p_service_data->data.size;
rgrover1 343:6675661fa600 398 }
rgrover1 343:6675661fa600 399 }
rgrover1 343:6675661fa600 400
rgrover1 343:6675661fa600 401 return NRF_SUCCESS;
rgrover1 343:6675661fa600 402 }
rgrover1 343:6675661fa600 403
rgrover1 343:6675661fa600 404
rgrover1 343:6675661fa600 405 static uint32_t adv_data_encode(const ble_advdata_t * p_advdata,
rgrover1 343:6675661fa600 406 uint8_t * p_encoded_data,
rgrover1 343:6675661fa600 407 uint8_t * p_len)
rgrover1 343:6675661fa600 408 {
rgrover1 343:6675661fa600 409 uint32_t err_code = NRF_SUCCESS;
rgrover1 343:6675661fa600 410
rgrover1 343:6675661fa600 411 *p_len = 0;
rgrover1 343:6675661fa600 412
rgrover1 343:6675661fa600 413 // Encode name.
rgrover1 343:6675661fa600 414 if (p_advdata->name_type != BLE_ADVDATA_NO_NAME)
rgrover1 343:6675661fa600 415 {
rgrover1 343:6675661fa600 416 err_code = name_encode(p_advdata, p_encoded_data, p_len);
rgrover1 343:6675661fa600 417 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 418 {
rgrover1 343:6675661fa600 419 return err_code;
rgrover1 343:6675661fa600 420 }
rgrover1 343:6675661fa600 421 }
rgrover1 343:6675661fa600 422
rgrover1 343:6675661fa600 423 // Encode appearance.
rgrover1 343:6675661fa600 424 if (p_advdata->include_appearance)
rgrover1 343:6675661fa600 425 {
rgrover1 343:6675661fa600 426 err_code = appearance_encode(p_encoded_data, p_len);
rgrover1 343:6675661fa600 427 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 428 {
rgrover1 343:6675661fa600 429 return err_code;
rgrover1 343:6675661fa600 430 }
rgrover1 343:6675661fa600 431 }
rgrover1 343:6675661fa600 432
rgrover1 343:6675661fa600 433 if(p_advdata->flags != 0 )
rgrover1 343:6675661fa600 434 {
rgrover1 343:6675661fa600 435 // Encode flags.
rgrover1 343:6675661fa600 436 p_encoded_data[(*p_len)++] = 1 + sizeof(uint8_t);
rgrover1 343:6675661fa600 437 p_encoded_data[(*p_len)++] = BLE_GAP_AD_TYPE_FLAGS;
rgrover1 343:6675661fa600 438 p_encoded_data[(*p_len)++] = p_advdata->flags;
rgrover1 343:6675661fa600 439 }
rgrover1 343:6675661fa600 440
rgrover1 343:6675661fa600 441 // Encode TX power level.
rgrover1 343:6675661fa600 442 if (p_advdata->p_tx_power_level != NULL)
rgrover1 343:6675661fa600 443 {
rgrover1 343:6675661fa600 444 err_code = tx_power_level_encode(*p_advdata->p_tx_power_level, p_encoded_data, p_len);
rgrover1 343:6675661fa600 445 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 446 {
rgrover1 343:6675661fa600 447 return err_code;
rgrover1 343:6675661fa600 448 }
rgrover1 343:6675661fa600 449 }
rgrover1 343:6675661fa600 450
rgrover1 343:6675661fa600 451 // Encode 'more available' uuid list.
rgrover1 343:6675661fa600 452 if (p_advdata->uuids_more_available.uuid_cnt > 0)
rgrover1 343:6675661fa600 453 {
rgrover1 343:6675661fa600 454 err_code = uuid_list_encode(&p_advdata->uuids_more_available,
rgrover1 343:6675661fa600 455 BLE_GAP_AD_TYPE_16BIT_SERVICE_UUID_MORE_AVAILABLE,
rgrover1 343:6675661fa600 456 BLE_GAP_AD_TYPE_128BIT_SERVICE_UUID_MORE_AVAILABLE,
rgrover1 343:6675661fa600 457 p_encoded_data,
rgrover1 343:6675661fa600 458 p_len);
rgrover1 343:6675661fa600 459 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 460 {
rgrover1 343:6675661fa600 461 return err_code;
rgrover1 343:6675661fa600 462 }
rgrover1 343:6675661fa600 463 }
rgrover1 343:6675661fa600 464
rgrover1 343:6675661fa600 465 // Encode 'complete' uuid list.
rgrover1 343:6675661fa600 466 if (p_advdata->uuids_complete.uuid_cnt > 0)
rgrover1 343:6675661fa600 467 {
rgrover1 343:6675661fa600 468 err_code = uuid_list_encode(&p_advdata->uuids_complete,
rgrover1 343:6675661fa600 469 BLE_GAP_AD_TYPE_16BIT_SERVICE_UUID_COMPLETE,
rgrover1 343:6675661fa600 470 BLE_GAP_AD_TYPE_128BIT_SERVICE_UUID_COMPLETE,
rgrover1 343:6675661fa600 471 p_encoded_data,
rgrover1 343:6675661fa600 472 p_len);
rgrover1 343:6675661fa600 473 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 474 {
rgrover1 343:6675661fa600 475 return err_code;
rgrover1 343:6675661fa600 476 }
rgrover1 343:6675661fa600 477 }
rgrover1 343:6675661fa600 478
rgrover1 343:6675661fa600 479 // Encode 'solicited service' uuid list.
rgrover1 343:6675661fa600 480 if (p_advdata->uuids_solicited.uuid_cnt > 0)
rgrover1 343:6675661fa600 481 {
rgrover1 343:6675661fa600 482 err_code = uuid_list_encode(&p_advdata->uuids_solicited,
rgrover1 343:6675661fa600 483 BLE_GAP_AD_TYPE_SOLICITED_SERVICE_UUIDS_16BIT,
rgrover1 343:6675661fa600 484 BLE_GAP_AD_TYPE_SOLICITED_SERVICE_UUIDS_128BIT,
rgrover1 343:6675661fa600 485 p_encoded_data,
rgrover1 343:6675661fa600 486 p_len);
rgrover1 343:6675661fa600 487 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 488 {
rgrover1 343:6675661fa600 489 return err_code;
rgrover1 343:6675661fa600 490 }
rgrover1 343:6675661fa600 491 }
rgrover1 343:6675661fa600 492
rgrover1 343:6675661fa600 493 // Encode Slave Connection Interval Range.
rgrover1 343:6675661fa600 494 if (p_advdata->p_slave_conn_int != NULL)
rgrover1 343:6675661fa600 495 {
rgrover1 343:6675661fa600 496 err_code = conn_int_encode(p_advdata->p_slave_conn_int, p_encoded_data, p_len);
rgrover1 343:6675661fa600 497 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 498 {
rgrover1 343:6675661fa600 499 return err_code;
rgrover1 343:6675661fa600 500 }
rgrover1 343:6675661fa600 501 }
rgrover1 343:6675661fa600 502
rgrover1 343:6675661fa600 503 // Encode Manufacturer Specific Data.
rgrover1 343:6675661fa600 504 if (p_advdata->p_manuf_specific_data != NULL)
rgrover1 343:6675661fa600 505 {
rgrover1 343:6675661fa600 506 err_code = manuf_specific_data_encode(p_advdata->p_manuf_specific_data,
rgrover1 343:6675661fa600 507 p_encoded_data,
rgrover1 343:6675661fa600 508 p_len);
rgrover1 343:6675661fa600 509 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 510 {
rgrover1 343:6675661fa600 511 return err_code;
rgrover1 343:6675661fa600 512 }
rgrover1 343:6675661fa600 513 }
rgrover1 343:6675661fa600 514
rgrover1 343:6675661fa600 515 // Encode Service Data.
rgrover1 343:6675661fa600 516 if (p_advdata->service_data_count > 0)
rgrover1 343:6675661fa600 517 {
rgrover1 343:6675661fa600 518 err_code = service_data_encode(p_advdata, p_encoded_data, p_len);
rgrover1 343:6675661fa600 519 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 520 {
rgrover1 343:6675661fa600 521 return err_code;
rgrover1 343:6675661fa600 522 }
rgrover1 343:6675661fa600 523 }
rgrover1 343:6675661fa600 524
rgrover1 343:6675661fa600 525 return err_code;
rgrover1 343:6675661fa600 526 }
rgrover1 343:6675661fa600 527
rgrover1 343:6675661fa600 528
rgrover1 343:6675661fa600 529 static uint32_t advdata_check(const ble_advdata_t * p_advdata)
rgrover1 343:6675661fa600 530 {
rgrover1 343:6675661fa600 531 // Flags must be included in advertising data, and the BLE_GAP_ADV_FLAG_BR_EDR_NOT_SUPPORTED flag must be set.
rgrover1 343:6675661fa600 532 if (
rgrover1 343:6675661fa600 533 ((p_advdata->flags & BLE_GAP_ADV_FLAG_BR_EDR_NOT_SUPPORTED) == 0)
rgrover1 343:6675661fa600 534 )
rgrover1 343:6675661fa600 535 {
rgrover1 343:6675661fa600 536 return NRF_ERROR_INVALID_PARAM;
rgrover1 343:6675661fa600 537 }
rgrover1 343:6675661fa600 538
rgrover1 343:6675661fa600 539 return NRF_SUCCESS;
rgrover1 343:6675661fa600 540 }
rgrover1 343:6675661fa600 541
rgrover1 343:6675661fa600 542
rgrover1 343:6675661fa600 543 static uint32_t srdata_check(const ble_advdata_t * p_srdata)
rgrover1 343:6675661fa600 544 {
rgrover1 343:6675661fa600 545 // Flags shall not be included in the scan response data.
rgrover1 343:6675661fa600 546 if (p_srdata->flags)
rgrover1 343:6675661fa600 547 {
rgrover1 343:6675661fa600 548 return NRF_ERROR_INVALID_PARAM;
rgrover1 343:6675661fa600 549 }
rgrover1 343:6675661fa600 550
rgrover1 343:6675661fa600 551 return NRF_SUCCESS;
rgrover1 343:6675661fa600 552 }
rgrover1 343:6675661fa600 553
rgrover1 343:6675661fa600 554
rgrover1 343:6675661fa600 555 uint32_t ble_advdata_set(const ble_advdata_t * p_advdata, const ble_advdata_t * p_srdata)
rgrover1 343:6675661fa600 556 {
rgrover1 343:6675661fa600 557 uint32_t err_code;
rgrover1 343:6675661fa600 558 uint8_t len_advdata = 0;
rgrover1 343:6675661fa600 559 uint8_t len_srdata = 0;
rgrover1 343:6675661fa600 560 uint8_t encoded_advdata[BLE_GAP_ADV_MAX_SIZE];
rgrover1 343:6675661fa600 561 uint8_t encoded_srdata[BLE_GAP_ADV_MAX_SIZE];
rgrover1 343:6675661fa600 562 uint8_t * p_encoded_advdata;
rgrover1 343:6675661fa600 563 uint8_t * p_encoded_srdata;
rgrover1 343:6675661fa600 564
rgrover1 343:6675661fa600 565 // Encode advertising data (if supplied).
rgrover1 343:6675661fa600 566 if (p_advdata != NULL)
rgrover1 343:6675661fa600 567 {
rgrover1 343:6675661fa600 568 err_code = advdata_check(p_advdata);
rgrover1 343:6675661fa600 569 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 570 {
rgrover1 343:6675661fa600 571 return err_code;
rgrover1 343:6675661fa600 572 }
rgrover1 343:6675661fa600 573
rgrover1 343:6675661fa600 574 err_code = adv_data_encode(p_advdata, encoded_advdata, &len_advdata);
rgrover1 343:6675661fa600 575 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 576 {
rgrover1 343:6675661fa600 577 return err_code;
rgrover1 343:6675661fa600 578 }
rgrover1 343:6675661fa600 579 p_encoded_advdata = encoded_advdata;
rgrover1 343:6675661fa600 580 }
rgrover1 343:6675661fa600 581 else
rgrover1 343:6675661fa600 582 {
rgrover1 343:6675661fa600 583 p_encoded_advdata = NULL;
rgrover1 343:6675661fa600 584 }
rgrover1 343:6675661fa600 585
rgrover1 343:6675661fa600 586 // Encode scan response data (if supplied).
rgrover1 343:6675661fa600 587 if (p_srdata != NULL)
rgrover1 343:6675661fa600 588 {
rgrover1 343:6675661fa600 589 err_code = srdata_check(p_srdata);
rgrover1 343:6675661fa600 590 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 591 {
rgrover1 343:6675661fa600 592 return err_code;
rgrover1 343:6675661fa600 593 }
rgrover1 343:6675661fa600 594
rgrover1 343:6675661fa600 595 err_code = adv_data_encode(p_srdata, encoded_srdata, &len_srdata);
rgrover1 343:6675661fa600 596 if (err_code != NRF_SUCCESS)
rgrover1 343:6675661fa600 597 {
rgrover1 343:6675661fa600 598 return err_code;
rgrover1 343:6675661fa600 599 }
rgrover1 343:6675661fa600 600 p_encoded_srdata = encoded_srdata;
rgrover1 343:6675661fa600 601 }
rgrover1 343:6675661fa600 602 else
rgrover1 343:6675661fa600 603 {
rgrover1 343:6675661fa600 604 p_encoded_srdata = NULL;
rgrover1 343:6675661fa600 605 }
rgrover1 343:6675661fa600 606
rgrover1 343:6675661fa600 607 // Pass encoded advertising data and/or scan response data to the stack.
rgrover1 343:6675661fa600 608 return sd_ble_gap_adv_data_set(p_encoded_advdata, len_advdata, p_encoded_srdata, len_srdata);
rgrover1 343:6675661fa600 609 }