Nordic stack and drivers for the mbed BLE API
Fork of nRF51822 by
TARGET_NRF5/source/btle/custom/custom_helper.cpp@639:4794dfdc59c0, 2017-11-09 (annotated)
- Committer:
- amithy
- Date:
- Thu Nov 09 22:13:54 2017 +0000
- Revision:
- 639:4794dfdc59c0
- Parent:
- 638:c90ae1400bf2
for testing export
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Vincent Coubard |
638:c90ae1400bf2 | 1 | /* mbed Microcontroller Library |
Vincent Coubard |
638:c90ae1400bf2 | 2 | * Copyright (c) 2006-2013 ARM Limited |
Vincent Coubard |
638:c90ae1400bf2 | 3 | * |
Vincent Coubard |
638:c90ae1400bf2 | 4 | * Licensed under the Apache License, Version 2.0 (the "License"); |
Vincent Coubard |
638:c90ae1400bf2 | 5 | * you may not use this file except in compliance with the License. |
Vincent Coubard |
638:c90ae1400bf2 | 6 | * You may obtain a copy of the License at |
Vincent Coubard |
638:c90ae1400bf2 | 7 | * |
Vincent Coubard |
638:c90ae1400bf2 | 8 | * http://www.apache.org/licenses/LICENSE-2.0 |
Vincent Coubard |
638:c90ae1400bf2 | 9 | * |
Vincent Coubard |
638:c90ae1400bf2 | 10 | * Unless required by applicable law or agreed to in writing, software |
Vincent Coubard |
638:c90ae1400bf2 | 11 | * distributed under the License is distributed on an "AS IS" BASIS, |
Vincent Coubard |
638:c90ae1400bf2 | 12 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
Vincent Coubard |
638:c90ae1400bf2 | 13 | * See the License for the specific language governing permissions and |
Vincent Coubard |
638:c90ae1400bf2 | 14 | * limitations under the License. |
Vincent Coubard |
638:c90ae1400bf2 | 15 | */ |
Vincent Coubard |
638:c90ae1400bf2 | 16 | |
Vincent Coubard |
638:c90ae1400bf2 | 17 | #include "custom_helper.h" |
Vincent Coubard |
638:c90ae1400bf2 | 18 | |
Vincent Coubard |
638:c90ae1400bf2 | 19 | /* |
Vincent Coubard |
638:c90ae1400bf2 | 20 | * The current version of the soft-device doesn't handle duplicate 128-bit UUIDs |
Vincent Coubard |
638:c90ae1400bf2 | 21 | * very well. It is therefore necessary to filter away duplicates before |
Vincent Coubard |
638:c90ae1400bf2 | 22 | * passing long UUIDs to sd_ble_uuid_vs_add(). The following types and data |
Vincent Coubard |
638:c90ae1400bf2 | 23 | * structures involved in maintaining a local cache of 128-bit UUIDs. |
Vincent Coubard |
638:c90ae1400bf2 | 24 | */ |
Vincent Coubard |
638:c90ae1400bf2 | 25 | typedef struct { |
Vincent Coubard |
638:c90ae1400bf2 | 26 | UUID::LongUUIDBytes_t uuid; |
Vincent Coubard |
638:c90ae1400bf2 | 27 | uint8_t type; |
Vincent Coubard |
638:c90ae1400bf2 | 28 | } converted_uuid_table_entry_t; |
Vincent Coubard |
638:c90ae1400bf2 | 29 | |
Vincent Coubard |
638:c90ae1400bf2 | 30 | static unsigned uuidTableEntries = 0; /* current usage of the table */ |
Vincent Coubard |
638:c90ae1400bf2 | 31 | converted_uuid_table_entry_t convertedUUIDTable[UUID_TABLE_MAX_ENTRIES]; |
Vincent Coubard |
638:c90ae1400bf2 | 32 | |
Vincent Coubard |
638:c90ae1400bf2 | 33 | void custom_reset_128bits_uuid_table() { |
Vincent Coubard |
638:c90ae1400bf2 | 34 | uuidTableEntries = 0; |
Vincent Coubard |
638:c90ae1400bf2 | 35 | } |
Vincent Coubard |
638:c90ae1400bf2 | 36 | |
Vincent Coubard |
638:c90ae1400bf2 | 37 | /** |
Vincent Coubard |
638:c90ae1400bf2 | 38 | * lookup the cache of previously converted 128-bit UUIDs to find a type value. |
Vincent Coubard |
638:c90ae1400bf2 | 39 | * @param uuid base 128-bit UUID |
Vincent Coubard |
638:c90ae1400bf2 | 40 | * @param recoveredType the type field of the 3-byte nRF's uuid. |
Vincent Coubard |
638:c90ae1400bf2 | 41 | * @return true if a match is found. |
Vincent Coubard |
638:c90ae1400bf2 | 42 | */ |
Vincent Coubard |
638:c90ae1400bf2 | 43 | static bool |
Vincent Coubard |
638:c90ae1400bf2 | 44 | lookupConvertedUUIDTable(const UUID::LongUUIDBytes_t uuid, uint8_t *recoveredType) |
Vincent Coubard |
638:c90ae1400bf2 | 45 | { |
Vincent Coubard |
638:c90ae1400bf2 | 46 | unsigned i; |
Vincent Coubard |
638:c90ae1400bf2 | 47 | for (i = 0; i < uuidTableEntries; i++) { |
Vincent Coubard |
638:c90ae1400bf2 | 48 | unsigned byteIndex; |
Vincent Coubard |
638:c90ae1400bf2 | 49 | for (byteIndex = 0; byteIndex < UUID::LENGTH_OF_LONG_UUID; byteIndex++) { |
Vincent Coubard |
638:c90ae1400bf2 | 50 | /* Skip bytes 2 and 3, because they contain the shortUUID (16-bit) version of the |
Vincent Coubard |
638:c90ae1400bf2 | 51 | * long UUID; and we're comparing against the remainder. */ |
Vincent Coubard |
638:c90ae1400bf2 | 52 | if ((byteIndex == 2) || (byteIndex == 3)) { |
Vincent Coubard |
638:c90ae1400bf2 | 53 | continue; |
Vincent Coubard |
638:c90ae1400bf2 | 54 | } |
Vincent Coubard |
638:c90ae1400bf2 | 55 | |
Vincent Coubard |
638:c90ae1400bf2 | 56 | if (convertedUUIDTable[i].uuid[byteIndex] != uuid[byteIndex]) { |
Vincent Coubard |
638:c90ae1400bf2 | 57 | break; |
Vincent Coubard |
638:c90ae1400bf2 | 58 | } |
Vincent Coubard |
638:c90ae1400bf2 | 59 | } |
Vincent Coubard |
638:c90ae1400bf2 | 60 | |
Vincent Coubard |
638:c90ae1400bf2 | 61 | if (byteIndex == UUID::LENGTH_OF_LONG_UUID) { |
Vincent Coubard |
638:c90ae1400bf2 | 62 | *recoveredType = convertedUUIDTable[i].type; |
Vincent Coubard |
638:c90ae1400bf2 | 63 | return true; |
Vincent Coubard |
638:c90ae1400bf2 | 64 | } |
Vincent Coubard |
638:c90ae1400bf2 | 65 | } |
Vincent Coubard |
638:c90ae1400bf2 | 66 | |
Vincent Coubard |
638:c90ae1400bf2 | 67 | return false; |
Vincent Coubard |
638:c90ae1400bf2 | 68 | } |
Vincent Coubard |
638:c90ae1400bf2 | 69 | |
Vincent Coubard |
638:c90ae1400bf2 | 70 | static void |
Vincent Coubard |
638:c90ae1400bf2 | 71 | addToConvertedUUIDTable(const UUID::LongUUIDBytes_t uuid, uint8_t type) |
Vincent Coubard |
638:c90ae1400bf2 | 72 | { |
Vincent Coubard |
638:c90ae1400bf2 | 73 | if (uuidTableEntries == UUID_TABLE_MAX_ENTRIES) { |
Vincent Coubard |
638:c90ae1400bf2 | 74 | return; /* recovery needed; or at least the user should be warned about this fact.*/ |
Vincent Coubard |
638:c90ae1400bf2 | 75 | } |
Vincent Coubard |
638:c90ae1400bf2 | 76 | |
Vincent Coubard |
638:c90ae1400bf2 | 77 | memcpy(convertedUUIDTable[uuidTableEntries].uuid, uuid, UUID::LENGTH_OF_LONG_UUID); |
Vincent Coubard |
638:c90ae1400bf2 | 78 | convertedUUIDTable[uuidTableEntries].uuid[2] = 0; |
Vincent Coubard |
638:c90ae1400bf2 | 79 | convertedUUIDTable[uuidTableEntries].uuid[3] = 0; |
Vincent Coubard |
638:c90ae1400bf2 | 80 | convertedUUIDTable[uuidTableEntries].type = type; |
Vincent Coubard |
638:c90ae1400bf2 | 81 | uuidTableEntries++; |
Vincent Coubard |
638:c90ae1400bf2 | 82 | } |
Vincent Coubard |
638:c90ae1400bf2 | 83 | |
Vincent Coubard |
638:c90ae1400bf2 | 84 | /** |
Vincent Coubard |
638:c90ae1400bf2 | 85 | * The nRF transport has its own 3-byte representation of a UUID. If the user- |
Vincent Coubard |
638:c90ae1400bf2 | 86 | * specified UUID is 128-bits wide, then the UUID base needs to be added to the |
Vincent Coubard |
638:c90ae1400bf2 | 87 | * soft-device and converted to a 3-byte handle before being used further. This |
Vincent Coubard |
638:c90ae1400bf2 | 88 | * function is responsible for this translation of user-specified UUIDs into |
Vincent Coubard |
638:c90ae1400bf2 | 89 | * nRF's representation. |
Vincent Coubard |
638:c90ae1400bf2 | 90 | * |
Vincent Coubard |
638:c90ae1400bf2 | 91 | * @param[in] uuid |
Vincent Coubard |
638:c90ae1400bf2 | 92 | * user-specified UUID |
Vincent Coubard |
638:c90ae1400bf2 | 93 | * @return nRF |
Vincent Coubard |
638:c90ae1400bf2 | 94 | * 3-byte UUID (containing a type and 16-bit UUID) representation |
Vincent Coubard |
638:c90ae1400bf2 | 95 | * to be used with SVC calls. |
Vincent Coubard |
638:c90ae1400bf2 | 96 | */ |
Vincent Coubard |
638:c90ae1400bf2 | 97 | ble_uuid_t custom_convert_to_nordic_uuid(const UUID &uuid) |
Vincent Coubard |
638:c90ae1400bf2 | 98 | { |
Vincent Coubard |
638:c90ae1400bf2 | 99 | ble_uuid_t nordicUUID; |
Vincent Coubard |
638:c90ae1400bf2 | 100 | nordicUUID.uuid = uuid.getShortUUID(); |
Vincent Coubard |
638:c90ae1400bf2 | 101 | nordicUUID.type = BLE_UUID_TYPE_UNKNOWN; /* to be set below */ |
Vincent Coubard |
638:c90ae1400bf2 | 102 | |
Vincent Coubard |
638:c90ae1400bf2 | 103 | if (uuid.shortOrLong() == UUID::UUID_TYPE_SHORT) { |
Vincent Coubard |
638:c90ae1400bf2 | 104 | nordicUUID.type = BLE_UUID_TYPE_BLE; |
Vincent Coubard |
638:c90ae1400bf2 | 105 | } else { |
Vincent Coubard |
638:c90ae1400bf2 | 106 | if (!lookupConvertedUUIDTable(uuid.getBaseUUID(), &nordicUUID.type)) { |
Vincent Coubard |
638:c90ae1400bf2 | 107 | nordicUUID.type = custom_add_uuid_base(uuid.getBaseUUID()); |
Vincent Coubard |
638:c90ae1400bf2 | 108 | addToConvertedUUIDTable(uuid.getBaseUUID(), nordicUUID.type); |
Vincent Coubard |
638:c90ae1400bf2 | 109 | } |
Vincent Coubard |
638:c90ae1400bf2 | 110 | } |
Vincent Coubard |
638:c90ae1400bf2 | 111 | |
Vincent Coubard |
638:c90ae1400bf2 | 112 | return nordicUUID; |
Vincent Coubard |
638:c90ae1400bf2 | 113 | } |
Vincent Coubard |
638:c90ae1400bf2 | 114 | |
Vincent Coubard |
638:c90ae1400bf2 | 115 | /**************************************************************************/ |
Vincent Coubard |
638:c90ae1400bf2 | 116 | /*! |
Vincent Coubard |
638:c90ae1400bf2 | 117 | @brief Adds the base UUID to the custom service. All UUIDs used |
Vincent Coubard |
638:c90ae1400bf2 | 118 | by this service are based on this 128-bit UUID. |
Vincent Coubard |
638:c90ae1400bf2 | 119 | |
Vincent Coubard |
638:c90ae1400bf2 | 120 | @note This UUID needs to be added to the SoftDevice stack before |
Vincent Coubard |
638:c90ae1400bf2 | 121 | adding the service's primary service via |
Vincent Coubard |
638:c90ae1400bf2 | 122 | 'sd_ble_gatts_service_add' |
Vincent Coubard |
638:c90ae1400bf2 | 123 | |
Vincent Coubard |
638:c90ae1400bf2 | 124 | @param[in] p_uuid_base A pointer to the 128-bit UUID array (8*16) |
Vincent Coubard |
638:c90ae1400bf2 | 125 | |
Vincent Coubard |
638:c90ae1400bf2 | 126 | @returns The UUID type. |
Vincent Coubard |
638:c90ae1400bf2 | 127 | A return value of 0 should be considered an error. |
Vincent Coubard |
638:c90ae1400bf2 | 128 | |
Vincent Coubard |
638:c90ae1400bf2 | 129 | @retval 0x00 BLE_UUID_TYPE_UNKNOWN |
Vincent Coubard |
638:c90ae1400bf2 | 130 | @retval 0x01 BLE_UUID_TYPE_BLE |
Vincent Coubard |
638:c90ae1400bf2 | 131 | @retval 0x02 BLE_UUID_TYPE_VENDOR_BEGIN |
Vincent Coubard |
638:c90ae1400bf2 | 132 | |
Vincent Coubard |
638:c90ae1400bf2 | 133 | @section EXAMPLE |
Vincent Coubard |
638:c90ae1400bf2 | 134 | @code |
Vincent Coubard |
638:c90ae1400bf2 | 135 | |
Vincent Coubard |
638:c90ae1400bf2 | 136 | // Take note that bytes 2/3 are blank since these are used to identify |
Vincent Coubard |
638:c90ae1400bf2 | 137 | // the primary service and individual characteristics |
Vincent Coubard |
638:c90ae1400bf2 | 138 | #define CFG_CUSTOM_UUID_BASE "\x6E\x40\x00\x00\xB5\xA3\xF3\x93\xE0\xA9\xE5\x0E\x24\xDC\xCA\x9E" |
Vincent Coubard |
638:c90ae1400bf2 | 139 | |
Vincent Coubard |
638:c90ae1400bf2 | 140 | uint8_t uuid_type = custom_add_uuid_base(CFG_CUSTOM_UUID_BASE); |
Vincent Coubard |
638:c90ae1400bf2 | 141 | ASSERT(uuid_type > 0, ERROR_NOT_FOUND); |
Vincent Coubard |
638:c90ae1400bf2 | 142 | |
Vincent Coubard |
638:c90ae1400bf2 | 143 | // We can now safely add the primary service and any characteristics |
Vincent Coubard |
638:c90ae1400bf2 | 144 | // for our custom service ... |
Vincent Coubard |
638:c90ae1400bf2 | 145 | |
Vincent Coubard |
638:c90ae1400bf2 | 146 | @endcode |
Vincent Coubard |
638:c90ae1400bf2 | 147 | */ |
Vincent Coubard |
638:c90ae1400bf2 | 148 | /**************************************************************************/ |
Vincent Coubard |
638:c90ae1400bf2 | 149 | uint8_t custom_add_uuid_base(uint8_t const *const p_uuid_base) |
Vincent Coubard |
638:c90ae1400bf2 | 150 | { |
Vincent Coubard |
638:c90ae1400bf2 | 151 | ble_uuid128_t base_uuid; |
Vincent Coubard |
638:c90ae1400bf2 | 152 | uint8_t uuid_type = 0; |
Vincent Coubard |
638:c90ae1400bf2 | 153 | |
Vincent Coubard |
638:c90ae1400bf2 | 154 | for (unsigned i = 0; i < UUID::LENGTH_OF_LONG_UUID; i++) { |
Vincent Coubard |
638:c90ae1400bf2 | 155 | base_uuid.uuid128[i] = p_uuid_base[i]; |
Vincent Coubard |
638:c90ae1400bf2 | 156 | } |
Vincent Coubard |
638:c90ae1400bf2 | 157 | |
Vincent Coubard |
638:c90ae1400bf2 | 158 | ASSERT_INT( ERROR_NONE, sd_ble_uuid_vs_add( &base_uuid, &uuid_type ), 0); |
Vincent Coubard |
638:c90ae1400bf2 | 159 | |
Vincent Coubard |
638:c90ae1400bf2 | 160 | return uuid_type; |
Vincent Coubard |
638:c90ae1400bf2 | 161 | } |
Vincent Coubard |
638:c90ae1400bf2 | 162 | |
Vincent Coubard |
638:c90ae1400bf2 | 163 | /**************************************************************************/ |
Vincent Coubard |
638:c90ae1400bf2 | 164 | /*! |
Vincent Coubard |
638:c90ae1400bf2 | 165 | |
Vincent Coubard |
638:c90ae1400bf2 | 166 | */ |
Vincent Coubard |
638:c90ae1400bf2 | 167 | /**************************************************************************/ |
Vincent Coubard |
638:c90ae1400bf2 | 168 | error_t custom_decode_uuid_base(uint8_t const *const p_uuid_base, |
Vincent Coubard |
638:c90ae1400bf2 | 169 | ble_uuid_t *p_uuid) |
Vincent Coubard |
638:c90ae1400bf2 | 170 | { |
Vincent Coubard |
638:c90ae1400bf2 | 171 | UUID::LongUUIDBytes_t uuid_base_le; |
Vincent Coubard |
638:c90ae1400bf2 | 172 | |
Vincent Coubard |
638:c90ae1400bf2 | 173 | for (uint8_t i = 0; i < UUID::LENGTH_OF_LONG_UUID; i++) { |
Vincent Coubard |
638:c90ae1400bf2 | 174 | uuid_base_le[i] = p_uuid_base[i]; |
Vincent Coubard |
638:c90ae1400bf2 | 175 | } |
Vincent Coubard |
638:c90ae1400bf2 | 176 | |
Vincent Coubard |
638:c90ae1400bf2 | 177 | ASSERT_STATUS( sd_ble_uuid_decode(UUID::LENGTH_OF_LONG_UUID, uuid_base_le, p_uuid)); |
Vincent Coubard |
638:c90ae1400bf2 | 178 | |
Vincent Coubard |
638:c90ae1400bf2 | 179 | return ERROR_NONE; |
Vincent Coubard |
638:c90ae1400bf2 | 180 | } |
Vincent Coubard |
638:c90ae1400bf2 | 181 | |
Vincent Coubard |
638:c90ae1400bf2 | 182 | /**************************************************************************/ |
Vincent Coubard |
638:c90ae1400bf2 | 183 | /*! |
Vincent Coubard |
638:c90ae1400bf2 | 184 | @brief Adds a new characteristic to the custom service, assigning |
Vincent Coubard |
638:c90ae1400bf2 | 185 | properties, a UUID add-on value, etc. |
Vincent Coubard |
638:c90ae1400bf2 | 186 | |
Vincent Coubard |
638:c90ae1400bf2 | 187 | @param[in] service_handle |
Vincent Coubard |
638:c90ae1400bf2 | 188 | @param[in] p_uuid The 16-bit value to add to the base UUID |
Vincent Coubard |
638:c90ae1400bf2 | 189 | for this characteristic (normally >1 |
Vincent Coubard |
638:c90ae1400bf2 | 190 | since 1 is typically used by the primary |
Vincent Coubard |
638:c90ae1400bf2 | 191 | service). |
Vincent Coubard |
638:c90ae1400bf2 | 192 | @param[in] char_props The characteristic properties, as |
Vincent Coubard |
638:c90ae1400bf2 | 193 | defined by ble_gatt_char_props_t |
Vincent Coubard |
638:c90ae1400bf2 | 194 | @param[in] max_length The maximum length of this characeristic |
Vincent Coubard |
638:c90ae1400bf2 | 195 | @param[in] has_variable_len Whether the characteristic data has |
Vincent Coubard |
638:c90ae1400bf2 | 196 | variable length. |
Vincent Coubard |
638:c90ae1400bf2 | 197 | @param[out] p_char_handle |
Vincent Coubard |
638:c90ae1400bf2 | 198 | |
Vincent Coubard |
638:c90ae1400bf2 | 199 | @returns |
Vincent Coubard |
638:c90ae1400bf2 | 200 | @retval ERROR_NONE Everything executed normally |
Vincent Coubard |
638:c90ae1400bf2 | 201 | */ |
Vincent Coubard |
638:c90ae1400bf2 | 202 | /**************************************************************************/ |
Vincent Coubard |
638:c90ae1400bf2 | 203 | error_t custom_add_in_characteristic(uint16_t service_handle, |
Vincent Coubard |
638:c90ae1400bf2 | 204 | ble_uuid_t *p_uuid, |
Vincent Coubard |
638:c90ae1400bf2 | 205 | uint8_t properties, |
Vincent Coubard |
638:c90ae1400bf2 | 206 | SecurityManager::SecurityMode_t requiredSecurity, |
Vincent Coubard |
638:c90ae1400bf2 | 207 | uint8_t *p_data, |
Vincent Coubard |
638:c90ae1400bf2 | 208 | uint16_t length, |
Vincent Coubard |
638:c90ae1400bf2 | 209 | uint16_t max_length, |
Vincent Coubard |
638:c90ae1400bf2 | 210 | bool has_variable_len, |
Vincent Coubard |
638:c90ae1400bf2 | 211 | const uint8_t *userDescriptionDescriptorValuePtr, |
Vincent Coubard |
638:c90ae1400bf2 | 212 | uint16_t userDescriptionDescriptorValueLen, |
Vincent Coubard |
638:c90ae1400bf2 | 213 | bool readAuthorization, |
Vincent Coubard |
638:c90ae1400bf2 | 214 | bool writeAuthorization, |
Vincent Coubard |
638:c90ae1400bf2 | 215 | ble_gatts_char_handles_t *p_char_handle) |
Vincent Coubard |
638:c90ae1400bf2 | 216 | { |
Vincent Coubard |
638:c90ae1400bf2 | 217 | /* Characteristic metadata */ |
Vincent Coubard |
638:c90ae1400bf2 | 218 | ble_gatts_attr_md_t cccd_md; |
Vincent Coubard |
638:c90ae1400bf2 | 219 | ble_gatt_char_props_t char_props; |
Vincent Coubard |
638:c90ae1400bf2 | 220 | |
Vincent Coubard |
638:c90ae1400bf2 | 221 | memcpy(&char_props, &properties, 1); |
Vincent Coubard |
638:c90ae1400bf2 | 222 | |
Vincent Coubard |
638:c90ae1400bf2 | 223 | if (char_props.notify || char_props.indicate) { |
Vincent Coubard |
638:c90ae1400bf2 | 224 | /* Notification requires cccd */ |
Vincent Coubard |
638:c90ae1400bf2 | 225 | memclr_( &cccd_md, sizeof(ble_gatts_attr_md_t)); |
Vincent Coubard |
638:c90ae1400bf2 | 226 | cccd_md.vloc = BLE_GATTS_VLOC_STACK; |
Vincent Coubard |
638:c90ae1400bf2 | 227 | BLE_GAP_CONN_SEC_MODE_SET_OPEN(&cccd_md.read_perm); |
Vincent Coubard |
638:c90ae1400bf2 | 228 | BLE_GAP_CONN_SEC_MODE_SET_OPEN(&cccd_md.write_perm); |
Vincent Coubard |
638:c90ae1400bf2 | 229 | } |
Vincent Coubard |
638:c90ae1400bf2 | 230 | |
Vincent Coubard |
638:c90ae1400bf2 | 231 | ble_gatts_char_md_t char_md = {0}; |
Vincent Coubard |
638:c90ae1400bf2 | 232 | |
Vincent Coubard |
638:c90ae1400bf2 | 233 | char_md.char_props = char_props; |
Vincent Coubard |
638:c90ae1400bf2 | 234 | char_md.p_cccd_md = |
Vincent Coubard |
638:c90ae1400bf2 | 235 | (char_props.notify || char_props.indicate) ? &cccd_md : NULL; |
Vincent Coubard |
638:c90ae1400bf2 | 236 | if ((userDescriptionDescriptorValueLen > 0) && (userDescriptionDescriptorValuePtr != NULL)) { |
Vincent Coubard |
638:c90ae1400bf2 | 237 | char_md.p_char_user_desc = const_cast<uint8_t *>(userDescriptionDescriptorValuePtr); |
Vincent Coubard |
638:c90ae1400bf2 | 238 | char_md.char_user_desc_max_size = userDescriptionDescriptorValueLen; |
Vincent Coubard |
638:c90ae1400bf2 | 239 | char_md.char_user_desc_size = userDescriptionDescriptorValueLen; |
Vincent Coubard |
638:c90ae1400bf2 | 240 | } |
Vincent Coubard |
638:c90ae1400bf2 | 241 | |
Vincent Coubard |
638:c90ae1400bf2 | 242 | /* Attribute declaration */ |
Vincent Coubard |
638:c90ae1400bf2 | 243 | ble_gatts_attr_md_t attr_md = {0}; |
Vincent Coubard |
638:c90ae1400bf2 | 244 | |
Vincent Coubard |
638:c90ae1400bf2 | 245 | attr_md.rd_auth = readAuthorization; |
Vincent Coubard |
638:c90ae1400bf2 | 246 | attr_md.wr_auth = writeAuthorization; |
Vincent Coubard |
638:c90ae1400bf2 | 247 | |
Vincent Coubard |
638:c90ae1400bf2 | 248 | attr_md.vloc = BLE_GATTS_VLOC_STACK; |
Vincent Coubard |
638:c90ae1400bf2 | 249 | /* Always set variable size */ |
Vincent Coubard |
638:c90ae1400bf2 | 250 | attr_md.vlen = has_variable_len; |
Vincent Coubard |
638:c90ae1400bf2 | 251 | |
Vincent Coubard |
638:c90ae1400bf2 | 252 | if (char_props.read || char_props.notify || char_props.indicate) { |
Vincent Coubard |
638:c90ae1400bf2 | 253 | switch (requiredSecurity) { |
Vincent Coubard |
638:c90ae1400bf2 | 254 | case SecurityManager::SECURITY_MODE_ENCRYPTION_OPEN_LINK : |
Vincent Coubard |
638:c90ae1400bf2 | 255 | BLE_GAP_CONN_SEC_MODE_SET_OPEN(&attr_md.read_perm); |
Vincent Coubard |
638:c90ae1400bf2 | 256 | break; |
Vincent Coubard |
638:c90ae1400bf2 | 257 | case SecurityManager::SECURITY_MODE_ENCRYPTION_NO_MITM : |
Vincent Coubard |
638:c90ae1400bf2 | 258 | BLE_GAP_CONN_SEC_MODE_SET_ENC_NO_MITM(&attr_md.read_perm); |
Vincent Coubard |
638:c90ae1400bf2 | 259 | break; |
Vincent Coubard |
638:c90ae1400bf2 | 260 | case SecurityManager::SECURITY_MODE_ENCRYPTION_WITH_MITM : |
Vincent Coubard |
638:c90ae1400bf2 | 261 | BLE_GAP_CONN_SEC_MODE_SET_ENC_WITH_MITM(&attr_md.read_perm); |
Vincent Coubard |
638:c90ae1400bf2 | 262 | break; |
Vincent Coubard |
638:c90ae1400bf2 | 263 | case SecurityManager::SECURITY_MODE_SIGNED_NO_MITM : |
Vincent Coubard |
638:c90ae1400bf2 | 264 | BLE_GAP_CONN_SEC_MODE_SET_SIGNED_NO_MITM(&attr_md.read_perm); |
Vincent Coubard |
638:c90ae1400bf2 | 265 | break; |
Vincent Coubard |
638:c90ae1400bf2 | 266 | case SecurityManager::SECURITY_MODE_SIGNED_WITH_MITM : |
Vincent Coubard |
638:c90ae1400bf2 | 267 | BLE_GAP_CONN_SEC_MODE_SET_SIGNED_WITH_MITM(&attr_md.read_perm); |
Vincent Coubard |
638:c90ae1400bf2 | 268 | break; |
Vincent Coubard |
638:c90ae1400bf2 | 269 | default: |
Vincent Coubard |
638:c90ae1400bf2 | 270 | break; |
Vincent Coubard |
638:c90ae1400bf2 | 271 | }; |
Vincent Coubard |
638:c90ae1400bf2 | 272 | } |
Vincent Coubard |
638:c90ae1400bf2 | 273 | |
Vincent Coubard |
638:c90ae1400bf2 | 274 | if (char_props.write || char_props.write_wo_resp) { |
Vincent Coubard |
638:c90ae1400bf2 | 275 | switch (requiredSecurity) { |
Vincent Coubard |
638:c90ae1400bf2 | 276 | case SecurityManager::SECURITY_MODE_ENCRYPTION_OPEN_LINK : |
Vincent Coubard |
638:c90ae1400bf2 | 277 | BLE_GAP_CONN_SEC_MODE_SET_OPEN(&attr_md.write_perm); |
Vincent Coubard |
638:c90ae1400bf2 | 278 | break; |
Vincent Coubard |
638:c90ae1400bf2 | 279 | case SecurityManager::SECURITY_MODE_ENCRYPTION_NO_MITM : |
Vincent Coubard |
638:c90ae1400bf2 | 280 | BLE_GAP_CONN_SEC_MODE_SET_ENC_NO_MITM(&attr_md.write_perm); |
Vincent Coubard |
638:c90ae1400bf2 | 281 | break; |
Vincent Coubard |
638:c90ae1400bf2 | 282 | case SecurityManager::SECURITY_MODE_ENCRYPTION_WITH_MITM : |
Vincent Coubard |
638:c90ae1400bf2 | 283 | BLE_GAP_CONN_SEC_MODE_SET_ENC_WITH_MITM(&attr_md.write_perm); |
Vincent Coubard |
638:c90ae1400bf2 | 284 | break; |
Vincent Coubard |
638:c90ae1400bf2 | 285 | case SecurityManager::SECURITY_MODE_SIGNED_NO_MITM : |
Vincent Coubard |
638:c90ae1400bf2 | 286 | BLE_GAP_CONN_SEC_MODE_SET_SIGNED_NO_MITM(&attr_md.write_perm); |
Vincent Coubard |
638:c90ae1400bf2 | 287 | break; |
Vincent Coubard |
638:c90ae1400bf2 | 288 | case SecurityManager::SECURITY_MODE_SIGNED_WITH_MITM : |
Vincent Coubard |
638:c90ae1400bf2 | 289 | BLE_GAP_CONN_SEC_MODE_SET_SIGNED_WITH_MITM(&attr_md.write_perm); |
Vincent Coubard |
638:c90ae1400bf2 | 290 | break; |
Vincent Coubard |
638:c90ae1400bf2 | 291 | default: |
Vincent Coubard |
638:c90ae1400bf2 | 292 | break; |
Vincent Coubard |
638:c90ae1400bf2 | 293 | }; |
Vincent Coubard |
638:c90ae1400bf2 | 294 | } |
Vincent Coubard |
638:c90ae1400bf2 | 295 | |
Vincent Coubard |
638:c90ae1400bf2 | 296 | ble_gatts_attr_t attr_char_value = {0}; |
Vincent Coubard |
638:c90ae1400bf2 | 297 | |
Vincent Coubard |
638:c90ae1400bf2 | 298 | attr_char_value.p_uuid = p_uuid; |
Vincent Coubard |
638:c90ae1400bf2 | 299 | attr_char_value.p_attr_md = &attr_md; |
Vincent Coubard |
638:c90ae1400bf2 | 300 | attr_char_value.init_len = length; |
Vincent Coubard |
638:c90ae1400bf2 | 301 | attr_char_value.max_len = max_length; |
Vincent Coubard |
638:c90ae1400bf2 | 302 | attr_char_value.p_value = p_data; |
Vincent Coubard |
638:c90ae1400bf2 | 303 | |
Vincent Coubard |
638:c90ae1400bf2 | 304 | ASSERT_STATUS ( sd_ble_gatts_characteristic_add(service_handle, |
Vincent Coubard |
638:c90ae1400bf2 | 305 | &char_md, |
Vincent Coubard |
638:c90ae1400bf2 | 306 | &attr_char_value, |
Vincent Coubard |
638:c90ae1400bf2 | 307 | p_char_handle)); |
Vincent Coubard |
638:c90ae1400bf2 | 308 | |
Vincent Coubard |
638:c90ae1400bf2 | 309 | return ERROR_NONE; |
Vincent Coubard |
638:c90ae1400bf2 | 310 | } |
Vincent Coubard |
638:c90ae1400bf2 | 311 | |
Vincent Coubard |
638:c90ae1400bf2 | 312 | |
Vincent Coubard |
638:c90ae1400bf2 | 313 | |
Vincent Coubard |
638:c90ae1400bf2 | 314 | /**************************************************************************/ |
Vincent Coubard |
638:c90ae1400bf2 | 315 | /*! |
Vincent Coubard |
638:c90ae1400bf2 | 316 | @brief Adds a new descriptor to the custom service, assigning |
Vincent Coubard |
638:c90ae1400bf2 | 317 | value, a UUID add-on value, etc. |
Vincent Coubard |
638:c90ae1400bf2 | 318 | |
Vincent Coubard |
638:c90ae1400bf2 | 319 | @param[in] char_handle |
Vincent Coubard |
638:c90ae1400bf2 | 320 | @param[in] p_uuid The 16-bit value to add to the base UUID |
Vincent Coubard |
638:c90ae1400bf2 | 321 | for this descriptor (normally >1 |
Vincent Coubard |
638:c90ae1400bf2 | 322 | since 1 is typically used by the primary |
Vincent Coubard |
638:c90ae1400bf2 | 323 | service). |
Vincent Coubard |
638:c90ae1400bf2 | 324 | @param[in] max_length The maximum length of this descriptor |
Vincent Coubard |
638:c90ae1400bf2 | 325 | @param[in] has_variable_len Whether the characteristic data has |
Vincent Coubard |
638:c90ae1400bf2 | 326 | variable length. |
Vincent Coubard |
638:c90ae1400bf2 | 327 | |
Vincent Coubard |
638:c90ae1400bf2 | 328 | @returns |
Vincent Coubard |
638:c90ae1400bf2 | 329 | @retval ERROR_NONE Everything executed normally |
Vincent Coubard |
638:c90ae1400bf2 | 330 | */ |
Vincent Coubard |
638:c90ae1400bf2 | 331 | /**************************************************************************/ |
Vincent Coubard |
638:c90ae1400bf2 | 332 | error_t custom_add_in_descriptor(uint16_t char_handle, |
Vincent Coubard |
638:c90ae1400bf2 | 333 | ble_uuid_t *p_uuid, |
Vincent Coubard |
638:c90ae1400bf2 | 334 | uint8_t *p_data, |
Vincent Coubard |
638:c90ae1400bf2 | 335 | uint16_t length, |
Vincent Coubard |
638:c90ae1400bf2 | 336 | uint16_t max_length, |
Vincent Coubard |
638:c90ae1400bf2 | 337 | bool has_variable_len, |
Vincent Coubard |
638:c90ae1400bf2 | 338 | uint16_t *p_desc_handle) |
Vincent Coubard |
638:c90ae1400bf2 | 339 | { |
Vincent Coubard |
638:c90ae1400bf2 | 340 | /* Descriptor metadata */ |
Vincent Coubard |
638:c90ae1400bf2 | 341 | ble_gatts_attr_md_t desc_md = {0}; |
Vincent Coubard |
638:c90ae1400bf2 | 342 | |
Vincent Coubard |
638:c90ae1400bf2 | 343 | desc_md.vloc = BLE_GATTS_VLOC_STACK; |
Vincent Coubard |
638:c90ae1400bf2 | 344 | /* Always set variable size */ |
Vincent Coubard |
638:c90ae1400bf2 | 345 | desc_md.vlen = has_variable_len; |
Vincent Coubard |
638:c90ae1400bf2 | 346 | |
Vincent Coubard |
638:c90ae1400bf2 | 347 | /* Make it readable and writable */ |
Vincent Coubard |
638:c90ae1400bf2 | 348 | BLE_GAP_CONN_SEC_MODE_SET_OPEN(&desc_md.read_perm); |
Vincent Coubard |
638:c90ae1400bf2 | 349 | BLE_GAP_CONN_SEC_MODE_SET_OPEN(&desc_md.write_perm); |
Vincent Coubard |
638:c90ae1400bf2 | 350 | |
Vincent Coubard |
638:c90ae1400bf2 | 351 | ble_gatts_attr_t attr_desc = {0}; |
Vincent Coubard |
638:c90ae1400bf2 | 352 | |
Vincent Coubard |
638:c90ae1400bf2 | 353 | attr_desc.p_uuid = p_uuid; |
Vincent Coubard |
638:c90ae1400bf2 | 354 | attr_desc.p_attr_md = &desc_md; |
Vincent Coubard |
638:c90ae1400bf2 | 355 | attr_desc.init_len = length; |
Vincent Coubard |
638:c90ae1400bf2 | 356 | attr_desc.max_len = max_length; |
Vincent Coubard |
638:c90ae1400bf2 | 357 | attr_desc.p_value = p_data; |
Vincent Coubard |
638:c90ae1400bf2 | 358 | |
Vincent Coubard |
638:c90ae1400bf2 | 359 | ASSERT_STATUS ( sd_ble_gatts_descriptor_add(char_handle, |
Vincent Coubard |
638:c90ae1400bf2 | 360 | &attr_desc, |
Vincent Coubard |
638:c90ae1400bf2 | 361 | p_desc_handle)); |
Vincent Coubard |
638:c90ae1400bf2 | 362 | |
Vincent Coubard |
638:c90ae1400bf2 | 363 | return ERROR_NONE; |
Vincent Coubard |
638:c90ae1400bf2 | 364 | } |