nochanges
Dependents: BLE_Acceleration_Statejudging
Fork of nRF51822 by
nordic/ble/ble_bondmngr.cpp@0:eff01767de02, 2014-03-26 (annotated)
- Committer:
- bogdanm
- Date:
- Wed Mar 26 14:38:17 2014 +0000
- Revision:
- 0:eff01767de02
- Child:
- 32:84dea0924a63
Initial import of the nRF51822 code
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
bogdanm | 0:eff01767de02 | 1 | /* Copyright (c) 2012 Nordic Semiconductor. All Rights Reserved. |
bogdanm | 0:eff01767de02 | 2 | * |
bogdanm | 0:eff01767de02 | 3 | * The information contained herein is property of Nordic Semiconductor ASA. |
bogdanm | 0:eff01767de02 | 4 | * Terms and conditions of usage are described in detail in NORDIC |
bogdanm | 0:eff01767de02 | 5 | * SEMICONDUCTOR STANDARD SOFTWARE LICENSE AGREEMENT. |
bogdanm | 0:eff01767de02 | 6 | * |
bogdanm | 0:eff01767de02 | 7 | * Licensees are granted free, non-transferable use of the information. NO |
bogdanm | 0:eff01767de02 | 8 | * WARRANTY of ANY KIND is provided. This heading must NOT be removed from |
bogdanm | 0:eff01767de02 | 9 | * the file. |
bogdanm | 0:eff01767de02 | 10 | * |
bogdanm | 0:eff01767de02 | 11 | */ |
bogdanm | 0:eff01767de02 | 12 | |
bogdanm | 0:eff01767de02 | 13 | #include "ble_bondmngr.h" |
bogdanm | 0:eff01767de02 | 14 | #include <stdlib.h> |
bogdanm | 0:eff01767de02 | 15 | #include <stdint.h> |
bogdanm | 0:eff01767de02 | 16 | #include <string.h> |
bogdanm | 0:eff01767de02 | 17 | #include "nordic_common.h" |
bogdanm | 0:eff01767de02 | 18 | #include "nrf_error.h" |
bogdanm | 0:eff01767de02 | 19 | #include "ble_gap.h" |
bogdanm | 0:eff01767de02 | 20 | #include "ble_srv_common.h" |
bogdanm | 0:eff01767de02 | 21 | #include "app_util.h" |
bogdanm | 0:eff01767de02 | 22 | #include "nrf_assert.h" |
bogdanm | 0:eff01767de02 | 23 | //#include "nrf.h" |
bogdanm | 0:eff01767de02 | 24 | #include "nrf51_bitfields.h" |
bogdanm | 0:eff01767de02 | 25 | #include "crc16.h" |
bogdanm | 0:eff01767de02 | 26 | #include "pstorage.h" |
bogdanm | 0:eff01767de02 | 27 | #include "ble_bondmngr_cfg.h" |
bogdanm | 0:eff01767de02 | 28 | |
bogdanm | 0:eff01767de02 | 29 | #define CCCD_SIZE 6 /**< Number of bytes needed for storing the state of one CCCD. */ |
bogdanm | 0:eff01767de02 | 30 | #define CRC_SIZE 2 /**< Size of CRC in sys_attribute data. */ |
bogdanm | 0:eff01767de02 | 31 | #define SYS_ATTR_BUFFER_MAX_LEN (((BLE_BONDMNGR_CCCD_COUNT + 1) * CCCD_SIZE) + CRC_SIZE) /**< Size of sys_attribute data. */ |
bogdanm | 0:eff01767de02 | 32 | #define MAX_NUM_CENTRAL_WHITE_LIST MIN(BLE_BONDMNGR_MAX_BONDED_CENTRALS, 8) /**< Maximum number of whitelisted centrals supported.*/ |
bogdanm | 0:eff01767de02 | 33 | #define MAX_BONDS_IN_FLASH 10 /**< Maximum number of bonds that can be stored in flash. */ |
bogdanm | 0:eff01767de02 | 34 | #define BOND_MANAGER_DATA_SIGNATURE 0x53240000 |
bogdanm | 0:eff01767de02 | 35 | |
bogdanm | 0:eff01767de02 | 36 | /**@defgroup ble_bond_mngr_sec_access Bond Manager Security Status Access Macros |
bogdanm | 0:eff01767de02 | 37 | * @brief The following group of macros abstract access to Security Status with a peer. |
bogdanm | 0:eff01767de02 | 38 | * @{ |
bogdanm | 0:eff01767de02 | 39 | */ |
bogdanm | 0:eff01767de02 | 40 | |
bogdanm | 0:eff01767de02 | 41 | #define SEC_STATUS_INIT_VAL 0x00 /**< Initialization value for security status flags. */ |
bogdanm | 0:eff01767de02 | 42 | #define ENC_STATUS_SET_VAL 0x01 /**< Bitmask for encryption status. */ |
bogdanm | 0:eff01767de02 | 43 | #define BOND_IN_PROGRESS_SET_VAL 0x02 /**< Bitmask for 'bonding in progress'. */ |
bogdanm | 0:eff01767de02 | 44 | |
bogdanm | 0:eff01767de02 | 45 | |
bogdanm | 0:eff01767de02 | 46 | /**@brief Macro for setting the Encryption Status for current link. |
bogdanm | 0:eff01767de02 | 47 | * |
bogdanm | 0:eff01767de02 | 48 | * @details Macro for setting the Encryption Status for current link. |
bogdanm | 0:eff01767de02 | 49 | */ |
bogdanm | 0:eff01767de02 | 50 | #define ENCRYPTION_STATUS_SET() \ |
bogdanm | 0:eff01767de02 | 51 | do \ |
bogdanm | 0:eff01767de02 | 52 | { \ |
bogdanm | 0:eff01767de02 | 53 | m_sec_con_status |= ENC_STATUS_SET_VAL; \ |
bogdanm | 0:eff01767de02 | 54 | } while (0) |
bogdanm | 0:eff01767de02 | 55 | |
bogdanm | 0:eff01767de02 | 56 | /**@brief Macro for getting the Encryption Status for current link. |
bogdanm | 0:eff01767de02 | 57 | * |
bogdanm | 0:eff01767de02 | 58 | * @details Macro for getting the Encryption Status for current link. |
bogdanm | 0:eff01767de02 | 59 | */ |
bogdanm | 0:eff01767de02 | 60 | #define ENCRYPTION_STATUS_GET() \ |
bogdanm | 0:eff01767de02 | 61 | (((m_sec_con_status & ENC_STATUS_SET_VAL) == 0) ? false : true) |
bogdanm | 0:eff01767de02 | 62 | |
bogdanm | 0:eff01767de02 | 63 | /**@brief Macro for resetting the Encryption Status for current link. |
bogdanm | 0:eff01767de02 | 64 | * |
bogdanm | 0:eff01767de02 | 65 | * @details Macro for resetting the Encryption Status for current link. |
bogdanm | 0:eff01767de02 | 66 | */ |
bogdanm | 0:eff01767de02 | 67 | #define ENCRYPTION_STATUS_RESET() \ |
bogdanm | 0:eff01767de02 | 68 | do \ |
bogdanm | 0:eff01767de02 | 69 | { \ |
bogdanm | 0:eff01767de02 | 70 | m_sec_con_status &= (~ENC_STATUS_SET_VAL); \ |
bogdanm | 0:eff01767de02 | 71 | } while (0) |
bogdanm | 0:eff01767de02 | 72 | |
bogdanm | 0:eff01767de02 | 73 | |
bogdanm | 0:eff01767de02 | 74 | /**@brief Macro for resetting the Bonding In Progress status for current link. |
bogdanm | 0:eff01767de02 | 75 | * |
bogdanm | 0:eff01767de02 | 76 | * @details Macro for resetting the Bonding In Progress status for current link. |
bogdanm | 0:eff01767de02 | 77 | */ |
bogdanm | 0:eff01767de02 | 78 | #define BONDING_IN_PROGRESS_STATUS_SET() \ |
bogdanm | 0:eff01767de02 | 79 | do \ |
bogdanm | 0:eff01767de02 | 80 | { \ |
bogdanm | 0:eff01767de02 | 81 | m_sec_con_status |= BOND_IN_PROGRESS_SET_VAL; \ |
bogdanm | 0:eff01767de02 | 82 | } while (0) |
bogdanm | 0:eff01767de02 | 83 | |
bogdanm | 0:eff01767de02 | 84 | /**@brief Macro for setting the Bonding In Progress status for current link. |
bogdanm | 0:eff01767de02 | 85 | * |
bogdanm | 0:eff01767de02 | 86 | * @details Macro for setting the Bonding In Progress status for current link. |
bogdanm | 0:eff01767de02 | 87 | */ |
bogdanm | 0:eff01767de02 | 88 | #define BONDING_IN_PROGRESS_STATUS_GET() \ |
bogdanm | 0:eff01767de02 | 89 | (((m_sec_con_status & BOND_IN_PROGRESS_SET_VAL) == 0) ? false: true) |
bogdanm | 0:eff01767de02 | 90 | |
bogdanm | 0:eff01767de02 | 91 | /**@brief Macro for resetting the Bonding In Progress status for current link. |
bogdanm | 0:eff01767de02 | 92 | * |
bogdanm | 0:eff01767de02 | 93 | * @details Macro for resetting the Bonding In Progress status for current link. |
bogdanm | 0:eff01767de02 | 94 | */ |
bogdanm | 0:eff01767de02 | 95 | #define BONDING_IN_PROGRESS_STATUS_RESET() \ |
bogdanm | 0:eff01767de02 | 96 | do \ |
bogdanm | 0:eff01767de02 | 97 | { \ |
bogdanm | 0:eff01767de02 | 98 | m_sec_con_status &= (~BOND_IN_PROGRESS_SET_VAL); \ |
bogdanm | 0:eff01767de02 | 99 | } while (0) |
bogdanm | 0:eff01767de02 | 100 | |
bogdanm | 0:eff01767de02 | 101 | /**@brief Macro for resetting all security status flags for current link. |
bogdanm | 0:eff01767de02 | 102 | * |
bogdanm | 0:eff01767de02 | 103 | * @details Macro for resetting all security status flags for current link. |
bogdanm | 0:eff01767de02 | 104 | */ |
bogdanm | 0:eff01767de02 | 105 | #define SECURITY_STATUS_RESET() \ |
bogdanm | 0:eff01767de02 | 106 | do \ |
bogdanm | 0:eff01767de02 | 107 | { \ |
bogdanm | 0:eff01767de02 | 108 | m_sec_con_status = SEC_STATUS_INIT_VAL; \ |
bogdanm | 0:eff01767de02 | 109 | } while (0) |
bogdanm | 0:eff01767de02 | 110 | |
bogdanm | 0:eff01767de02 | 111 | /** @} */ |
bogdanm | 0:eff01767de02 | 112 | |
bogdanm | 0:eff01767de02 | 113 | /**@brief Verify module's initialization status. |
bogdanm | 0:eff01767de02 | 114 | * |
bogdanm | 0:eff01767de02 | 115 | * @details Verify module's initialization status. Returns NRF_INVALID_STATE in case a module API |
bogdanm | 0:eff01767de02 | 116 | * is called without initializing the module. |
bogdanm | 0:eff01767de02 | 117 | */ |
bogdanm | 0:eff01767de02 | 118 | #define VERIFY_MODULE_INITIALIZED() \ |
bogdanm | 0:eff01767de02 | 119 | do \ |
bogdanm | 0:eff01767de02 | 120 | { \ |
bogdanm | 0:eff01767de02 | 121 | if (!m_is_bondmngr_initialized) \ |
bogdanm | 0:eff01767de02 | 122 | { \ |
bogdanm | 0:eff01767de02 | 123 | return NRF_ERROR_INVALID_STATE; \ |
bogdanm | 0:eff01767de02 | 124 | } \ |
bogdanm | 0:eff01767de02 | 125 | } while(0) |
bogdanm | 0:eff01767de02 | 126 | |
bogdanm | 0:eff01767de02 | 127 | |
bogdanm | 0:eff01767de02 | 128 | /**@brief This structure contains the Bonding Information for one central. |
bogdanm | 0:eff01767de02 | 129 | */ |
bogdanm | 0:eff01767de02 | 130 | typedef struct |
bogdanm | 0:eff01767de02 | 131 | { |
bogdanm | 0:eff01767de02 | 132 | int32_t central_handle; /**< Central's handle (NOTE: Size is 32 bits just to make struct size dividable by 4). */ |
bogdanm | 0:eff01767de02 | 133 | ble_gap_evt_auth_status_t auth_status; /**< Central authentication data. */ |
bogdanm | 0:eff01767de02 | 134 | ble_gap_evt_sec_info_request_t central_id_info; /**< Central identification info. */ |
bogdanm | 0:eff01767de02 | 135 | ble_gap_addr_t central_addr; /**< Central's address. */ |
bogdanm | 0:eff01767de02 | 136 | } central_bond_t; |
bogdanm | 0:eff01767de02 | 137 | |
bogdanm | 0:eff01767de02 | 138 | STATIC_ASSERT(sizeof(central_bond_t) % 4 == 0); |
bogdanm | 0:eff01767de02 | 139 | |
bogdanm | 0:eff01767de02 | 140 | /**@brief This structure contains the System Attributes information related to one central. |
bogdanm | 0:eff01767de02 | 141 | */ |
bogdanm | 0:eff01767de02 | 142 | typedef struct |
bogdanm | 0:eff01767de02 | 143 | { |
bogdanm | 0:eff01767de02 | 144 | int32_t central_handle; /**< Central's handle (NOTE: Size is 32 bits just to make struct size dividable by 4). */ |
bogdanm | 0:eff01767de02 | 145 | uint8_t sys_attr[SYS_ATTR_BUFFER_MAX_LEN]; /**< Central sys_attribute data. */ |
bogdanm | 0:eff01767de02 | 146 | uint32_t sys_attr_size; /**< Central sys_attribute data's size (NOTE: Size is 32 bits just to make struct size dividable by 4). */ |
bogdanm | 0:eff01767de02 | 147 | } central_sys_attr_t; |
bogdanm | 0:eff01767de02 | 148 | |
bogdanm | 0:eff01767de02 | 149 | STATIC_ASSERT(sizeof(central_sys_attr_t) % 4 == 0); |
bogdanm | 0:eff01767de02 | 150 | |
bogdanm | 0:eff01767de02 | 151 | /**@brief This structure contains the Bonding Information and System Attributes related to one |
bogdanm | 0:eff01767de02 | 152 | * central. |
bogdanm | 0:eff01767de02 | 153 | */ |
bogdanm | 0:eff01767de02 | 154 | typedef struct |
bogdanm | 0:eff01767de02 | 155 | { |
bogdanm | 0:eff01767de02 | 156 | central_bond_t bond; /**< Bonding information. */ |
bogdanm | 0:eff01767de02 | 157 | central_sys_attr_t sys_attr; /**< System attribute information. */ |
bogdanm | 0:eff01767de02 | 158 | } central_t; |
bogdanm | 0:eff01767de02 | 159 | |
bogdanm | 0:eff01767de02 | 160 | /**@brief This structure contains the whitelisted addresses. |
bogdanm | 0:eff01767de02 | 161 | */ |
bogdanm | 0:eff01767de02 | 162 | typedef struct |
bogdanm | 0:eff01767de02 | 163 | { |
bogdanm | 0:eff01767de02 | 164 | int8_t central_handle; /**< Central's handle. */ |
bogdanm | 0:eff01767de02 | 165 | ble_gap_addr_t * p_addr; /**< Pointer to the central's address if BLE_GAP_ADDR_TYPE_PUBLIC. */ |
bogdanm | 0:eff01767de02 | 166 | } whitelist_addr_t; |
bogdanm | 0:eff01767de02 | 167 | |
bogdanm | 0:eff01767de02 | 168 | /**@brief This structure contains the whitelisted IRKs. |
bogdanm | 0:eff01767de02 | 169 | */ |
bogdanm | 0:eff01767de02 | 170 | typedef struct |
bogdanm | 0:eff01767de02 | 171 | { |
bogdanm | 0:eff01767de02 | 172 | int8_t central_handle; /**< Central's handle. */ |
bogdanm | 0:eff01767de02 | 173 | ble_gap_irk_t * p_irk; /**< Pointer to the central's irk if available. */ |
bogdanm | 0:eff01767de02 | 174 | } whitelist_irk_t; |
bogdanm | 0:eff01767de02 | 175 | |
bogdanm | 0:eff01767de02 | 176 | static bool m_is_bondmngr_initialized = false; /**< Flag for checking if module has been initialized. */ |
bogdanm | 0:eff01767de02 | 177 | static ble_bondmngr_init_t m_bondmngr_config; /**< Configuration as specified by the application. */ |
bogdanm | 0:eff01767de02 | 178 | static uint16_t m_conn_handle; /**< Current connection handle. */ |
bogdanm | 0:eff01767de02 | 179 | static central_t m_central; /**< Current central data. */ |
bogdanm | 0:eff01767de02 | 180 | static central_t m_centrals_db[BLE_BONDMNGR_MAX_BONDED_CENTRALS]; /**< Pointer to start of bonded centrals database. */ |
bogdanm | 0:eff01767de02 | 181 | static uint8_t m_centrals_in_db_count; /**< Number of bonded centrals. */ |
bogdanm | 0:eff01767de02 | 182 | static whitelist_addr_t m_whitelist_addr[MAX_NUM_CENTRAL_WHITE_LIST]; /**< List of central's addresses for the whitelist. */ |
bogdanm | 0:eff01767de02 | 183 | static whitelist_irk_t m_whitelist_irk[MAX_NUM_CENTRAL_WHITE_LIST]; /**< List of central's IRKs for the whitelist. */ |
bogdanm | 0:eff01767de02 | 184 | static uint8_t m_addr_count; /**< Number of addresses in the whitelist. */ |
bogdanm | 0:eff01767de02 | 185 | static uint8_t m_irk_count; /**< Number of IRKs in the whitelist. */ |
bogdanm | 0:eff01767de02 | 186 | static uint16_t m_crc_bond_info; /**< Combined CRC for all Bonding Information currently stored in flash. */ |
bogdanm | 0:eff01767de02 | 187 | static uint16_t m_crc_sys_attr; /**< Combined CRC for all System Attributes currently stored in flash. */ |
bogdanm | 0:eff01767de02 | 188 | static pstorage_handle_t mp_flash_bond_info; /**< Pointer to flash location to write next Bonding Information. */ |
bogdanm | 0:eff01767de02 | 189 | static pstorage_handle_t mp_flash_sys_attr; /**< Pointer to flash location to write next System Attribute information. */ |
bogdanm | 0:eff01767de02 | 190 | static uint8_t m_bond_info_in_flash_count; /**< Number of Bonding Information currently stored in flash. */ |
bogdanm | 0:eff01767de02 | 191 | static uint8_t m_sys_attr_in_flash_count; /**< Number of System Attributes currently stored in flash. */ |
bogdanm | 0:eff01767de02 | 192 | static uint8_t m_sec_con_status; /**< Variable to denote security status.*/ |
bogdanm | 0:eff01767de02 | 193 | static bool m_bond_loaded; /**< Variable to indicate if the bonding information of the currently connected central is available in the RAM.*/ |
bogdanm | 0:eff01767de02 | 194 | static bool m_sys_attr_loaded; /**< Variable to indicate if the system attribute information of the currently connected central is loaded from the database and set in the S110 SoftDevice.*/ |
bogdanm | 0:eff01767de02 | 195 | static uint32_t m_bond_crc_array[BLE_BONDMNGR_MAX_BONDED_CENTRALS]; |
bogdanm | 0:eff01767de02 | 196 | static uint32_t m_sys_crc_array[BLE_BONDMNGR_MAX_BONDED_CENTRALS]; |
bogdanm | 0:eff01767de02 | 197 | |
bogdanm | 0:eff01767de02 | 198 | /**@brief Function for extracting the CRC from an encoded 32 bit number that typical resides in |
bogdanm | 0:eff01767de02 | 199 | * the flash memory |
bogdanm | 0:eff01767de02 | 200 | * |
bogdanm | 0:eff01767de02 | 201 | * @param[in] header Header containing CRC and magic number. |
bogdanm | 0:eff01767de02 | 202 | * @param[out] p_crc Extracted CRC. |
bogdanm | 0:eff01767de02 | 203 | * |
bogdanm | 0:eff01767de02 | 204 | * @retval NRF_SUCCESS CRC successfully extracted. |
bogdanm | 0:eff01767de02 | 205 | * @retval NRF_ERROR_NOT_FOUND Flash seems to be empty. |
bogdanm | 0:eff01767de02 | 206 | * @retval NRF_ERROR_INVALID_DATA Header does not contain the magic number. |
bogdanm | 0:eff01767de02 | 207 | */ |
bogdanm | 0:eff01767de02 | 208 | static uint32_t crc_extract(uint32_t header, uint16_t * p_crc) |
bogdanm | 0:eff01767de02 | 209 | { |
bogdanm | 0:eff01767de02 | 210 | if ((header & 0xFFFF0000U) == BOND_MANAGER_DATA_SIGNATURE) |
bogdanm | 0:eff01767de02 | 211 | { |
bogdanm | 0:eff01767de02 | 212 | *p_crc = (uint16_t)(header & 0x0000FFFFU); |
bogdanm | 0:eff01767de02 | 213 | |
bogdanm | 0:eff01767de02 | 214 | return NRF_SUCCESS; |
bogdanm | 0:eff01767de02 | 215 | } |
bogdanm | 0:eff01767de02 | 216 | else if (header == 0xFFFFFFFFU) |
bogdanm | 0:eff01767de02 | 217 | { |
bogdanm | 0:eff01767de02 | 218 | return NRF_ERROR_NOT_FOUND; |
bogdanm | 0:eff01767de02 | 219 | } |
bogdanm | 0:eff01767de02 | 220 | else |
bogdanm | 0:eff01767de02 | 221 | { |
bogdanm | 0:eff01767de02 | 222 | return NRF_ERROR_INVALID_DATA; |
bogdanm | 0:eff01767de02 | 223 | } |
bogdanm | 0:eff01767de02 | 224 | } |
bogdanm | 0:eff01767de02 | 225 | |
bogdanm | 0:eff01767de02 | 226 | |
bogdanm | 0:eff01767de02 | 227 | /**@brief Function for storing the Bonding Information of the specified central to the flash. |
bogdanm | 0:eff01767de02 | 228 | * |
bogdanm | 0:eff01767de02 | 229 | * @param[in] p_bond Bonding information to be stored. |
bogdanm | 0:eff01767de02 | 230 | * |
bogdanm | 0:eff01767de02 | 231 | * @return NRF_SUCCESS on success, an error_code otherwise. |
bogdanm | 0:eff01767de02 | 232 | */ |
bogdanm | 0:eff01767de02 | 233 | static uint32_t bond_info_store(central_bond_t * p_bond) |
bogdanm | 0:eff01767de02 | 234 | { |
bogdanm | 0:eff01767de02 | 235 | uint32_t err_code; |
bogdanm | 0:eff01767de02 | 236 | pstorage_handle_t dest_block; |
bogdanm | 0:eff01767de02 | 237 | |
bogdanm | 0:eff01767de02 | 238 | // Check if flash is full |
bogdanm | 0:eff01767de02 | 239 | if (m_bond_info_in_flash_count >= MAX_BONDS_IN_FLASH) |
bogdanm | 0:eff01767de02 | 240 | { |
bogdanm | 0:eff01767de02 | 241 | return NRF_ERROR_NO_MEM; |
bogdanm | 0:eff01767de02 | 242 | } |
bogdanm | 0:eff01767de02 | 243 | |
bogdanm | 0:eff01767de02 | 244 | // Check if this is the first bond to be stored |
bogdanm | 0:eff01767de02 | 245 | if (m_bond_info_in_flash_count == 0) |
bogdanm | 0:eff01767de02 | 246 | { |
bogdanm | 0:eff01767de02 | 247 | // Initialize CRC |
bogdanm | 0:eff01767de02 | 248 | m_crc_bond_info = crc16_compute(NULL, 0, NULL); |
bogdanm | 0:eff01767de02 | 249 | } |
bogdanm | 0:eff01767de02 | 250 | |
bogdanm | 0:eff01767de02 | 251 | // Get block pointer from base |
bogdanm | 0:eff01767de02 | 252 | err_code = pstorage_block_identifier_get(&mp_flash_bond_info,m_bond_info_in_flash_count,&dest_block); |
bogdanm | 0:eff01767de02 | 253 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 254 | { |
bogdanm | 0:eff01767de02 | 255 | return err_code; |
bogdanm | 0:eff01767de02 | 256 | } |
bogdanm | 0:eff01767de02 | 257 | |
bogdanm | 0:eff01767de02 | 258 | // Write Bonding Information |
bogdanm | 0:eff01767de02 | 259 | err_code = pstorage_store(&dest_block, |
bogdanm | 0:eff01767de02 | 260 | (uint8_t *)p_bond, |
bogdanm | 0:eff01767de02 | 261 | sizeof(central_bond_t), |
bogdanm | 0:eff01767de02 | 262 | sizeof(uint32_t)); |
bogdanm | 0:eff01767de02 | 263 | |
bogdanm | 0:eff01767de02 | 264 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 265 | { |
bogdanm | 0:eff01767de02 | 266 | return err_code; |
bogdanm | 0:eff01767de02 | 267 | } |
bogdanm | 0:eff01767de02 | 268 | m_crc_bond_info = crc16_compute((uint8_t *)p_bond, |
bogdanm | 0:eff01767de02 | 269 | sizeof(central_bond_t), |
bogdanm | 0:eff01767de02 | 270 | &m_crc_bond_info); |
bogdanm | 0:eff01767de02 | 271 | |
bogdanm | 0:eff01767de02 | 272 | // Write header |
bogdanm | 0:eff01767de02 | 273 | m_bond_crc_array[m_bond_info_in_flash_count] = (BOND_MANAGER_DATA_SIGNATURE | m_crc_bond_info); |
bogdanm | 0:eff01767de02 | 274 | |
bogdanm | 0:eff01767de02 | 275 | err_code = pstorage_store (&dest_block, (uint8_t *)&m_bond_crc_array[m_bond_info_in_flash_count],sizeof(uint32_t),0); |
bogdanm | 0:eff01767de02 | 276 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 277 | { |
bogdanm | 0:eff01767de02 | 278 | return err_code; |
bogdanm | 0:eff01767de02 | 279 | } |
bogdanm | 0:eff01767de02 | 280 | |
bogdanm | 0:eff01767de02 | 281 | m_bond_info_in_flash_count++; |
bogdanm | 0:eff01767de02 | 282 | return NRF_SUCCESS; |
bogdanm | 0:eff01767de02 | 283 | } |
bogdanm | 0:eff01767de02 | 284 | |
bogdanm | 0:eff01767de02 | 285 | |
bogdanm | 0:eff01767de02 | 286 | /**@brief Function for storing the System Attributes related to a specified central in flash. |
bogdanm | 0:eff01767de02 | 287 | * |
bogdanm | 0:eff01767de02 | 288 | * @param[in] p_sys_attr System Attributes to be stored. |
bogdanm | 0:eff01767de02 | 289 | * |
bogdanm | 0:eff01767de02 | 290 | * @return NRF_SUCCESS on success, an error_code otherwise. |
bogdanm | 0:eff01767de02 | 291 | */ |
bogdanm | 0:eff01767de02 | 292 | static uint32_t sys_attr_store(central_sys_attr_t * p_sys_attr) |
bogdanm | 0:eff01767de02 | 293 | { |
bogdanm | 0:eff01767de02 | 294 | uint32_t err_code; |
bogdanm | 0:eff01767de02 | 295 | pstorage_handle_t dest_block; |
bogdanm | 0:eff01767de02 | 296 | |
bogdanm | 0:eff01767de02 | 297 | // Check if flash is full. |
bogdanm | 0:eff01767de02 | 298 | if (m_sys_attr_in_flash_count >= MAX_BONDS_IN_FLASH) |
bogdanm | 0:eff01767de02 | 299 | { |
bogdanm | 0:eff01767de02 | 300 | return NRF_ERROR_NO_MEM; |
bogdanm | 0:eff01767de02 | 301 | } |
bogdanm | 0:eff01767de02 | 302 | |
bogdanm | 0:eff01767de02 | 303 | // Check if this is the first time any System Attributes is stored. |
bogdanm | 0:eff01767de02 | 304 | if (m_sys_attr_in_flash_count == 0) |
bogdanm | 0:eff01767de02 | 305 | { |
bogdanm | 0:eff01767de02 | 306 | // Initialize CRC |
bogdanm | 0:eff01767de02 | 307 | m_crc_sys_attr = crc16_compute(NULL, 0, NULL); |
bogdanm | 0:eff01767de02 | 308 | } |
bogdanm | 0:eff01767de02 | 309 | |
bogdanm | 0:eff01767de02 | 310 | |
bogdanm | 0:eff01767de02 | 311 | // Get block pointer from base |
bogdanm | 0:eff01767de02 | 312 | err_code = pstorage_block_identifier_get(&mp_flash_sys_attr,m_sys_attr_in_flash_count,&dest_block); |
bogdanm | 0:eff01767de02 | 313 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 314 | { |
bogdanm | 0:eff01767de02 | 315 | return err_code; |
bogdanm | 0:eff01767de02 | 316 | } |
bogdanm | 0:eff01767de02 | 317 | |
bogdanm | 0:eff01767de02 | 318 | // Write System Attributes in flash. |
bogdanm | 0:eff01767de02 | 319 | err_code = pstorage_store(&dest_block, |
bogdanm | 0:eff01767de02 | 320 | (uint8_t *)p_sys_attr, |
bogdanm | 0:eff01767de02 | 321 | sizeof(central_sys_attr_t), |
bogdanm | 0:eff01767de02 | 322 | sizeof(uint32_t)); |
bogdanm | 0:eff01767de02 | 323 | |
bogdanm | 0:eff01767de02 | 324 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 325 | { |
bogdanm | 0:eff01767de02 | 326 | return err_code; |
bogdanm | 0:eff01767de02 | 327 | } |
bogdanm | 0:eff01767de02 | 328 | m_crc_sys_attr = crc16_compute((uint8_t *)p_sys_attr, |
bogdanm | 0:eff01767de02 | 329 | sizeof(central_sys_attr_t), |
bogdanm | 0:eff01767de02 | 330 | &m_crc_sys_attr); |
bogdanm | 0:eff01767de02 | 331 | |
bogdanm | 0:eff01767de02 | 332 | // Write header. |
bogdanm | 0:eff01767de02 | 333 | m_sys_crc_array[m_sys_attr_in_flash_count] = (BOND_MANAGER_DATA_SIGNATURE | m_crc_sys_attr); |
bogdanm | 0:eff01767de02 | 334 | |
bogdanm | 0:eff01767de02 | 335 | err_code = pstorage_store (&dest_block, |
bogdanm | 0:eff01767de02 | 336 | (uint8_t *)&m_sys_crc_array[m_sys_attr_in_flash_count], |
bogdanm | 0:eff01767de02 | 337 | sizeof(uint32_t), |
bogdanm | 0:eff01767de02 | 338 | 0); |
bogdanm | 0:eff01767de02 | 339 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 340 | { |
bogdanm | 0:eff01767de02 | 341 | return err_code; |
bogdanm | 0:eff01767de02 | 342 | } |
bogdanm | 0:eff01767de02 | 343 | |
bogdanm | 0:eff01767de02 | 344 | m_sys_attr_in_flash_count++; |
bogdanm | 0:eff01767de02 | 345 | |
bogdanm | 0:eff01767de02 | 346 | |
bogdanm | 0:eff01767de02 | 347 | return NRF_SUCCESS; |
bogdanm | 0:eff01767de02 | 348 | } |
bogdanm | 0:eff01767de02 | 349 | |
bogdanm | 0:eff01767de02 | 350 | |
bogdanm | 0:eff01767de02 | 351 | /**@brief Function for loading the Bonding Information of one central from flash. |
bogdanm | 0:eff01767de02 | 352 | * |
bogdanm | 0:eff01767de02 | 353 | * @param[out] p_bond Loaded Bonding Information. |
bogdanm | 0:eff01767de02 | 354 | * |
bogdanm | 0:eff01767de02 | 355 | * @return NRF_SUCCESS on success, otherwise an error code. |
bogdanm | 0:eff01767de02 | 356 | */ |
bogdanm | 0:eff01767de02 | 357 | static uint32_t bonding_info_load_from_flash(central_bond_t * p_bond) |
bogdanm | 0:eff01767de02 | 358 | { |
bogdanm | 0:eff01767de02 | 359 | pstorage_handle_t source_block; |
bogdanm | 0:eff01767de02 | 360 | uint32_t err_code; |
bogdanm | 0:eff01767de02 | 361 | uint32_t crc; |
bogdanm | 0:eff01767de02 | 362 | uint16_t crc_header; |
bogdanm | 0:eff01767de02 | 363 | |
bogdanm | 0:eff01767de02 | 364 | // Check if this is the first bond to be loaded, in which case the |
bogdanm | 0:eff01767de02 | 365 | // m_bond_info_in_flash_count variable would have the intial value 0. |
bogdanm | 0:eff01767de02 | 366 | if (m_bond_info_in_flash_count == 0) |
bogdanm | 0:eff01767de02 | 367 | { |
bogdanm | 0:eff01767de02 | 368 | // Initialize CRC. |
bogdanm | 0:eff01767de02 | 369 | m_crc_bond_info = crc16_compute(NULL, 0, NULL); |
bogdanm | 0:eff01767de02 | 370 | } |
bogdanm | 0:eff01767de02 | 371 | |
bogdanm | 0:eff01767de02 | 372 | // Get block pointer from base |
bogdanm | 0:eff01767de02 | 373 | err_code = pstorage_block_identifier_get(&mp_flash_bond_info, |
bogdanm | 0:eff01767de02 | 374 | m_bond_info_in_flash_count, |
bogdanm | 0:eff01767de02 | 375 | &source_block); |
bogdanm | 0:eff01767de02 | 376 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 377 | { |
bogdanm | 0:eff01767de02 | 378 | return err_code; |
bogdanm | 0:eff01767de02 | 379 | } |
bogdanm | 0:eff01767de02 | 380 | |
bogdanm | 0:eff01767de02 | 381 | err_code = pstorage_load((uint8_t *)&crc, &source_block, sizeof(uint32_t), 0); |
bogdanm | 0:eff01767de02 | 382 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 383 | { |
bogdanm | 0:eff01767de02 | 384 | return err_code; |
bogdanm | 0:eff01767de02 | 385 | } |
bogdanm | 0:eff01767de02 | 386 | |
bogdanm | 0:eff01767de02 | 387 | // Extract CRC from header. |
bogdanm | 0:eff01767de02 | 388 | err_code = crc_extract(crc, &crc_header); |
bogdanm | 0:eff01767de02 | 389 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 390 | { |
bogdanm | 0:eff01767de02 | 391 | return err_code; |
bogdanm | 0:eff01767de02 | 392 | } |
bogdanm | 0:eff01767de02 | 393 | |
bogdanm | 0:eff01767de02 | 394 | // Load central. |
bogdanm | 0:eff01767de02 | 395 | err_code = pstorage_load((uint8_t *)p_bond, |
bogdanm | 0:eff01767de02 | 396 | &source_block, |
bogdanm | 0:eff01767de02 | 397 | sizeof(central_bond_t), |
bogdanm | 0:eff01767de02 | 398 | sizeof(uint32_t)); |
bogdanm | 0:eff01767de02 | 399 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 400 | { |
bogdanm | 0:eff01767de02 | 401 | return err_code; |
bogdanm | 0:eff01767de02 | 402 | } |
bogdanm | 0:eff01767de02 | 403 | |
bogdanm | 0:eff01767de02 | 404 | // Check CRC. |
bogdanm | 0:eff01767de02 | 405 | m_crc_bond_info = crc16_compute((uint8_t *)p_bond, |
bogdanm | 0:eff01767de02 | 406 | sizeof(central_bond_t), |
bogdanm | 0:eff01767de02 | 407 | &m_crc_bond_info); |
bogdanm | 0:eff01767de02 | 408 | if (m_crc_bond_info == crc_header) |
bogdanm | 0:eff01767de02 | 409 | { |
bogdanm | 0:eff01767de02 | 410 | m_bond_info_in_flash_count++; |
bogdanm | 0:eff01767de02 | 411 | return NRF_SUCCESS; |
bogdanm | 0:eff01767de02 | 412 | } |
bogdanm | 0:eff01767de02 | 413 | else |
bogdanm | 0:eff01767de02 | 414 | { |
bogdanm | 0:eff01767de02 | 415 | return NRF_ERROR_INVALID_DATA; |
bogdanm | 0:eff01767de02 | 416 | } |
bogdanm | 0:eff01767de02 | 417 | } |
bogdanm | 0:eff01767de02 | 418 | |
bogdanm | 0:eff01767de02 | 419 | |
bogdanm | 0:eff01767de02 | 420 | |
bogdanm | 0:eff01767de02 | 421 | /**@brief Function for loading the System Attributes related to one central from flash. |
bogdanm | 0:eff01767de02 | 422 | * |
bogdanm | 0:eff01767de02 | 423 | * @param[out] p_sys_attr Loaded System Attributes. |
bogdanm | 0:eff01767de02 | 424 | * |
bogdanm | 0:eff01767de02 | 425 | * @return NRF_SUCCESS on success, otherwise an error code. |
bogdanm | 0:eff01767de02 | 426 | */ |
bogdanm | 0:eff01767de02 | 427 | static uint32_t sys_attr_load_from_flash(central_sys_attr_t * p_sys_attr) |
bogdanm | 0:eff01767de02 | 428 | { |
bogdanm | 0:eff01767de02 | 429 | pstorage_handle_t source_block; |
bogdanm | 0:eff01767de02 | 430 | uint32_t err_code; |
bogdanm | 0:eff01767de02 | 431 | uint32_t crc; |
bogdanm | 0:eff01767de02 | 432 | uint16_t crc_header; |
bogdanm | 0:eff01767de02 | 433 | |
bogdanm | 0:eff01767de02 | 434 | // Check if this is the first time System Attributes is loaded from flash, in which case the |
bogdanm | 0:eff01767de02 | 435 | // m_sys_attr_in_flash_count variable would have the initial value 0. |
bogdanm | 0:eff01767de02 | 436 | if (m_sys_attr_in_flash_count == 0) |
bogdanm | 0:eff01767de02 | 437 | { |
bogdanm | 0:eff01767de02 | 438 | // Initialize CRC. |
bogdanm | 0:eff01767de02 | 439 | m_crc_sys_attr = crc16_compute(NULL, 0, NULL); |
bogdanm | 0:eff01767de02 | 440 | } |
bogdanm | 0:eff01767de02 | 441 | |
bogdanm | 0:eff01767de02 | 442 | // Get block pointer from base |
bogdanm | 0:eff01767de02 | 443 | err_code = pstorage_block_identifier_get(&mp_flash_sys_attr, |
bogdanm | 0:eff01767de02 | 444 | m_sys_attr_in_flash_count, |
bogdanm | 0:eff01767de02 | 445 | &source_block); |
bogdanm | 0:eff01767de02 | 446 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 447 | { |
bogdanm | 0:eff01767de02 | 448 | return err_code; |
bogdanm | 0:eff01767de02 | 449 | } |
bogdanm | 0:eff01767de02 | 450 | |
bogdanm | 0:eff01767de02 | 451 | err_code = pstorage_load((uint8_t *)&crc, &source_block, sizeof(uint32_t), 0); |
bogdanm | 0:eff01767de02 | 452 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 453 | { |
bogdanm | 0:eff01767de02 | 454 | return err_code; |
bogdanm | 0:eff01767de02 | 455 | } |
bogdanm | 0:eff01767de02 | 456 | |
bogdanm | 0:eff01767de02 | 457 | // Extract CRC from header. |
bogdanm | 0:eff01767de02 | 458 | err_code = crc_extract(crc, &crc_header); |
bogdanm | 0:eff01767de02 | 459 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 460 | { |
bogdanm | 0:eff01767de02 | 461 | return err_code; |
bogdanm | 0:eff01767de02 | 462 | } |
bogdanm | 0:eff01767de02 | 463 | |
bogdanm | 0:eff01767de02 | 464 | err_code = pstorage_load((uint8_t *)p_sys_attr, |
bogdanm | 0:eff01767de02 | 465 | &source_block, |
bogdanm | 0:eff01767de02 | 466 | sizeof(central_sys_attr_t), |
bogdanm | 0:eff01767de02 | 467 | sizeof(uint32_t)); |
bogdanm | 0:eff01767de02 | 468 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 469 | { |
bogdanm | 0:eff01767de02 | 470 | return err_code; |
bogdanm | 0:eff01767de02 | 471 | } |
bogdanm | 0:eff01767de02 | 472 | |
bogdanm | 0:eff01767de02 | 473 | // Check CRC. |
bogdanm | 0:eff01767de02 | 474 | m_crc_sys_attr = crc16_compute((uint8_t *)p_sys_attr, |
bogdanm | 0:eff01767de02 | 475 | sizeof(central_sys_attr_t), |
bogdanm | 0:eff01767de02 | 476 | &m_crc_sys_attr); |
bogdanm | 0:eff01767de02 | 477 | |
bogdanm | 0:eff01767de02 | 478 | if (m_crc_sys_attr == crc_header) |
bogdanm | 0:eff01767de02 | 479 | { |
bogdanm | 0:eff01767de02 | 480 | m_sys_attr_in_flash_count++; |
bogdanm | 0:eff01767de02 | 481 | return NRF_SUCCESS; |
bogdanm | 0:eff01767de02 | 482 | } |
bogdanm | 0:eff01767de02 | 483 | else |
bogdanm | 0:eff01767de02 | 484 | { |
bogdanm | 0:eff01767de02 | 485 | return NRF_ERROR_INVALID_DATA; |
bogdanm | 0:eff01767de02 | 486 | } |
bogdanm | 0:eff01767de02 | 487 | } |
bogdanm | 0:eff01767de02 | 488 | |
bogdanm | 0:eff01767de02 | 489 | |
bogdanm | 0:eff01767de02 | 490 | /**@brief Function for erasing the flash pages that contain Bonding Information and System |
bogdanm | 0:eff01767de02 | 491 | * Attributes. |
bogdanm | 0:eff01767de02 | 492 | * |
bogdanm | 0:eff01767de02 | 493 | * @return NRF_SUCCESS on success, otherwise an error code. |
bogdanm | 0:eff01767de02 | 494 | */ |
bogdanm | 0:eff01767de02 | 495 | static uint32_t flash_pages_erase(void) |
bogdanm | 0:eff01767de02 | 496 | { |
bogdanm | 0:eff01767de02 | 497 | uint32_t err_code; |
bogdanm | 0:eff01767de02 | 498 | |
bogdanm | 0:eff01767de02 | 499 | err_code = pstorage_clear(&mp_flash_bond_info, MAX_BONDS_IN_FLASH); |
bogdanm | 0:eff01767de02 | 500 | |
bogdanm | 0:eff01767de02 | 501 | if (err_code == NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 502 | { |
bogdanm | 0:eff01767de02 | 503 | err_code = pstorage_clear(&mp_flash_sys_attr, MAX_BONDS_IN_FLASH); |
bogdanm | 0:eff01767de02 | 504 | } |
bogdanm | 0:eff01767de02 | 505 | |
bogdanm | 0:eff01767de02 | 506 | return err_code; |
bogdanm | 0:eff01767de02 | 507 | } |
bogdanm | 0:eff01767de02 | 508 | |
bogdanm | 0:eff01767de02 | 509 | |
bogdanm | 0:eff01767de02 | 510 | /**@brief Function for checking if Bonding Information in RAM is different from that in |
bogdanm | 0:eff01767de02 | 511 | * flash. |
bogdanm | 0:eff01767de02 | 512 | * |
bogdanm | 0:eff01767de02 | 513 | * @return TRUE if Bonding Information in flash and RAM are different, FALSE otherwise. |
bogdanm | 0:eff01767de02 | 514 | */ |
bogdanm | 0:eff01767de02 | 515 | static bool bond_info_changed(void) |
bogdanm | 0:eff01767de02 | 516 | { |
bogdanm | 0:eff01767de02 | 517 | int i; |
bogdanm | 0:eff01767de02 | 518 | uint16_t crc = crc16_compute(NULL, 0, NULL); |
bogdanm | 0:eff01767de02 | 519 | |
bogdanm | 0:eff01767de02 | 520 | // Compute CRC for all bonds in database. |
bogdanm | 0:eff01767de02 | 521 | for (i = 0; i < m_centrals_in_db_count; i++) |
bogdanm | 0:eff01767de02 | 522 | { |
bogdanm | 0:eff01767de02 | 523 | crc = crc16_compute((uint8_t *)&m_centrals_db[i].bond, |
bogdanm | 0:eff01767de02 | 524 | sizeof(central_bond_t), |
bogdanm | 0:eff01767de02 | 525 | &crc); |
bogdanm | 0:eff01767de02 | 526 | } |
bogdanm | 0:eff01767de02 | 527 | |
bogdanm | 0:eff01767de02 | 528 | // Compare the computed CRS to CRC stored in flash. |
bogdanm | 0:eff01767de02 | 529 | return (crc != m_crc_bond_info); |
bogdanm | 0:eff01767de02 | 530 | } |
bogdanm | 0:eff01767de02 | 531 | |
bogdanm | 0:eff01767de02 | 532 | |
bogdanm | 0:eff01767de02 | 533 | /**@brief Function for checking if System Attributes in RAM is different from that in flash. |
bogdanm | 0:eff01767de02 | 534 | * |
bogdanm | 0:eff01767de02 | 535 | * @return TRUE if System Attributes in flash and RAM are different, FALSE otherwise. |
bogdanm | 0:eff01767de02 | 536 | */ |
bogdanm | 0:eff01767de02 | 537 | static bool sys_attr_changed(void) |
bogdanm | 0:eff01767de02 | 538 | { |
bogdanm | 0:eff01767de02 | 539 | int i; |
bogdanm | 0:eff01767de02 | 540 | uint16_t crc = crc16_compute(NULL, 0, NULL); |
bogdanm | 0:eff01767de02 | 541 | |
bogdanm | 0:eff01767de02 | 542 | // Compute CRC for all System Attributes in database. |
bogdanm | 0:eff01767de02 | 543 | for (i = 0; i < m_centrals_in_db_count; i++) |
bogdanm | 0:eff01767de02 | 544 | { |
bogdanm | 0:eff01767de02 | 545 | crc = crc16_compute((uint8_t *)&m_centrals_db[i].sys_attr, |
bogdanm | 0:eff01767de02 | 546 | sizeof(central_sys_attr_t), |
bogdanm | 0:eff01767de02 | 547 | &crc); |
bogdanm | 0:eff01767de02 | 548 | } |
bogdanm | 0:eff01767de02 | 549 | |
bogdanm | 0:eff01767de02 | 550 | // Compare the CRC of System Attributes in flash with that of the System Attributes in memory. |
bogdanm | 0:eff01767de02 | 551 | return (crc != m_crc_sys_attr); |
bogdanm | 0:eff01767de02 | 552 | } |
bogdanm | 0:eff01767de02 | 553 | |
bogdanm | 0:eff01767de02 | 554 | |
bogdanm | 0:eff01767de02 | 555 | /**@brief Function for setting the System Attributes for specified central to the SoftDevice, or |
bogdanm | 0:eff01767de02 | 556 | * clearing the System Attributes if central is a previously unknown. |
bogdanm | 0:eff01767de02 | 557 | * |
bogdanm | 0:eff01767de02 | 558 | * @param[in] p_central Central for which the System Attributes is to be set. |
bogdanm | 0:eff01767de02 | 559 | * |
bogdanm | 0:eff01767de02 | 560 | * @return NRF_SUCCESS on success, otherwise an error code. |
bogdanm | 0:eff01767de02 | 561 | */ |
bogdanm | 0:eff01767de02 | 562 | static uint32_t central_sys_attr_set(central_t * p_central) |
bogdanm | 0:eff01767de02 | 563 | { |
bogdanm | 0:eff01767de02 | 564 | uint8_t * p_sys_attr; |
bogdanm | 0:eff01767de02 | 565 | |
bogdanm | 0:eff01767de02 | 566 | if (m_central.sys_attr.sys_attr_size != 0) |
bogdanm | 0:eff01767de02 | 567 | { |
bogdanm | 0:eff01767de02 | 568 | if (m_central.sys_attr.sys_attr_size > SYS_ATTR_BUFFER_MAX_LEN) |
bogdanm | 0:eff01767de02 | 569 | { |
bogdanm | 0:eff01767de02 | 570 | return NRF_ERROR_INTERNAL; |
bogdanm | 0:eff01767de02 | 571 | } |
bogdanm | 0:eff01767de02 | 572 | |
bogdanm | 0:eff01767de02 | 573 | p_sys_attr = m_central.sys_attr.sys_attr; |
bogdanm | 0:eff01767de02 | 574 | } |
bogdanm | 0:eff01767de02 | 575 | else |
bogdanm | 0:eff01767de02 | 576 | { |
bogdanm | 0:eff01767de02 | 577 | p_sys_attr = NULL; |
bogdanm | 0:eff01767de02 | 578 | } |
bogdanm | 0:eff01767de02 | 579 | |
bogdanm | 0:eff01767de02 | 580 | return sd_ble_gatts_sys_attr_set(m_conn_handle, p_sys_attr, m_central.sys_attr.sys_attr_size); |
bogdanm | 0:eff01767de02 | 581 | } |
bogdanm | 0:eff01767de02 | 582 | |
bogdanm | 0:eff01767de02 | 583 | |
bogdanm | 0:eff01767de02 | 584 | /**@brief Function for updating the whitelist data structures. |
bogdanm | 0:eff01767de02 | 585 | */ |
bogdanm | 0:eff01767de02 | 586 | static void update_whitelist(void) |
bogdanm | 0:eff01767de02 | 587 | { |
bogdanm | 0:eff01767de02 | 588 | int i; |
bogdanm | 0:eff01767de02 | 589 | |
bogdanm | 0:eff01767de02 | 590 | for (i = 0, m_addr_count = 0, m_irk_count = 0; i < m_centrals_in_db_count; i++) |
bogdanm | 0:eff01767de02 | 591 | { |
bogdanm | 0:eff01767de02 | 592 | central_bond_t * p_bond = &m_centrals_db[i].bond; |
bogdanm | 0:eff01767de02 | 593 | |
bogdanm | 0:eff01767de02 | 594 | if (p_bond->auth_status.central_kex.irk) |
bogdanm | 0:eff01767de02 | 595 | { |
bogdanm | 0:eff01767de02 | 596 | m_whitelist_irk[m_irk_count].central_handle = p_bond->central_handle; |
bogdanm | 0:eff01767de02 | 597 | m_whitelist_irk[m_irk_count].p_irk = &(p_bond->auth_status.central_keys.irk); |
bogdanm | 0:eff01767de02 | 598 | |
bogdanm | 0:eff01767de02 | 599 | m_irk_count++; |
bogdanm | 0:eff01767de02 | 600 | } |
bogdanm | 0:eff01767de02 | 601 | |
bogdanm | 0:eff01767de02 | 602 | if (p_bond->central_addr.addr_type != BLE_GAP_ADDR_TYPE_RANDOM_PRIVATE_RESOLVABLE) |
bogdanm | 0:eff01767de02 | 603 | { |
bogdanm | 0:eff01767de02 | 604 | m_whitelist_addr[m_addr_count].central_handle = p_bond->central_handle; |
bogdanm | 0:eff01767de02 | 605 | m_whitelist_addr[m_addr_count].p_addr = &(p_bond->central_addr); |
bogdanm | 0:eff01767de02 | 606 | |
bogdanm | 0:eff01767de02 | 607 | m_addr_count++; |
bogdanm | 0:eff01767de02 | 608 | } |
bogdanm | 0:eff01767de02 | 609 | } |
bogdanm | 0:eff01767de02 | 610 | } |
bogdanm | 0:eff01767de02 | 611 | |
bogdanm | 0:eff01767de02 | 612 | |
bogdanm | 0:eff01767de02 | 613 | /**@brief Function for handling the authentication status event related to a new central. |
bogdanm | 0:eff01767de02 | 614 | * |
bogdanm | 0:eff01767de02 | 615 | * @details This function adds the new central to the database and stores the central's Bonding |
bogdanm | 0:eff01767de02 | 616 | * Information to flash. It also notifies the application when the new bond is created, |
bogdanm | 0:eff01767de02 | 617 | * and sets the System Attributes to prepare the stack for connection with the new |
bogdanm | 0:eff01767de02 | 618 | * central. |
bogdanm | 0:eff01767de02 | 619 | * |
bogdanm | 0:eff01767de02 | 620 | * @param[in] p_auth_status New authentication status. |
bogdanm | 0:eff01767de02 | 621 | * |
bogdanm | 0:eff01767de02 | 622 | * @return NRF_SUCCESS on success, otherwise an error code. |
bogdanm | 0:eff01767de02 | 623 | */ |
bogdanm | 0:eff01767de02 | 624 | static uint32_t on_auth_status_from_new_central(ble_gap_evt_auth_status_t * p_auth_status) |
bogdanm | 0:eff01767de02 | 625 | { |
bogdanm | 0:eff01767de02 | 626 | uint32_t err_code; |
bogdanm | 0:eff01767de02 | 627 | |
bogdanm | 0:eff01767de02 | 628 | if (m_centrals_in_db_count >= BLE_BONDMNGR_MAX_BONDED_CENTRALS) |
bogdanm | 0:eff01767de02 | 629 | { |
bogdanm | 0:eff01767de02 | 630 | return NRF_ERROR_NO_MEM; |
bogdanm | 0:eff01767de02 | 631 | } |
bogdanm | 0:eff01767de02 | 632 | |
bogdanm | 0:eff01767de02 | 633 | // Update central. |
bogdanm | 0:eff01767de02 | 634 | m_central.bond.auth_status = *p_auth_status; |
bogdanm | 0:eff01767de02 | 635 | m_central.bond.central_id_info.div = p_auth_status->periph_keys.enc_info.div; |
bogdanm | 0:eff01767de02 | 636 | m_central.sys_attr.sys_attr_size = 0; |
bogdanm | 0:eff01767de02 | 637 | |
bogdanm | 0:eff01767de02 | 638 | // Add new central to database. |
bogdanm | 0:eff01767de02 | 639 | m_central.bond.central_handle = m_centrals_in_db_count; |
bogdanm | 0:eff01767de02 | 640 | m_centrals_db[m_centrals_in_db_count++] = m_central; |
bogdanm | 0:eff01767de02 | 641 | |
bogdanm | 0:eff01767de02 | 642 | update_whitelist(); |
bogdanm | 0:eff01767de02 | 643 | |
bogdanm | 0:eff01767de02 | 644 | m_bond_loaded = true; |
bogdanm | 0:eff01767de02 | 645 | |
bogdanm | 0:eff01767de02 | 646 | // Clear System Attributes. |
bogdanm | 0:eff01767de02 | 647 | err_code = sd_ble_gatts_sys_attr_set(m_conn_handle, NULL, 0); |
bogdanm | 0:eff01767de02 | 648 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 649 | { |
bogdanm | 0:eff01767de02 | 650 | return err_code; |
bogdanm | 0:eff01767de02 | 651 | } |
bogdanm | 0:eff01767de02 | 652 | |
bogdanm | 0:eff01767de02 | 653 | // Write new central's Bonding Information to flash. |
bogdanm | 0:eff01767de02 | 654 | err_code = bond_info_store(&m_central.bond); |
bogdanm | 0:eff01767de02 | 655 | if ((err_code == NRF_ERROR_NO_MEM) && (m_bondmngr_config.evt_handler != NULL)) |
bogdanm | 0:eff01767de02 | 656 | { |
bogdanm | 0:eff01767de02 | 657 | ble_bondmngr_evt_t evt; |
bogdanm | 0:eff01767de02 | 658 | |
bogdanm | 0:eff01767de02 | 659 | evt.evt_type = BLE_BONDMNGR_EVT_BOND_FLASH_FULL; |
bogdanm | 0:eff01767de02 | 660 | evt.central_handle = m_central.bond.central_handle; |
bogdanm | 0:eff01767de02 | 661 | evt.central_id = m_central.bond.central_id_info.div; |
bogdanm | 0:eff01767de02 | 662 | |
bogdanm | 0:eff01767de02 | 663 | m_bondmngr_config.evt_handler(&evt); |
bogdanm | 0:eff01767de02 | 664 | } |
bogdanm | 0:eff01767de02 | 665 | else if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 666 | { |
bogdanm | 0:eff01767de02 | 667 | return err_code; |
bogdanm | 0:eff01767de02 | 668 | } |
bogdanm | 0:eff01767de02 | 669 | |
bogdanm | 0:eff01767de02 | 670 | // Pass the event to application. |
bogdanm | 0:eff01767de02 | 671 | if (m_bondmngr_config.evt_handler != NULL) |
bogdanm | 0:eff01767de02 | 672 | { |
bogdanm | 0:eff01767de02 | 673 | ble_bondmngr_evt_t evt; |
bogdanm | 0:eff01767de02 | 674 | |
bogdanm | 0:eff01767de02 | 675 | evt.evt_type = BLE_BONDMNGR_EVT_NEW_BOND; |
bogdanm | 0:eff01767de02 | 676 | evt.central_handle = m_central.bond.central_handle; |
bogdanm | 0:eff01767de02 | 677 | evt.central_id = m_central.bond.central_id_info.div; |
bogdanm | 0:eff01767de02 | 678 | |
bogdanm | 0:eff01767de02 | 679 | m_bondmngr_config.evt_handler(&evt); |
bogdanm | 0:eff01767de02 | 680 | } |
bogdanm | 0:eff01767de02 | 681 | |
bogdanm | 0:eff01767de02 | 682 | return NRF_SUCCESS; |
bogdanm | 0:eff01767de02 | 683 | } |
bogdanm | 0:eff01767de02 | 684 | |
bogdanm | 0:eff01767de02 | 685 | |
bogdanm | 0:eff01767de02 | 686 | /**@brief Function for updating the current central's entry in the database. |
bogdanm | 0:eff01767de02 | 687 | */ |
bogdanm | 0:eff01767de02 | 688 | static uint32_t central_update(void) |
bogdanm | 0:eff01767de02 | 689 | { |
bogdanm | 0:eff01767de02 | 690 | uint32_t err_code; |
bogdanm | 0:eff01767de02 | 691 | int32_t central_handle = m_central.bond.central_handle; |
bogdanm | 0:eff01767de02 | 692 | |
bogdanm | 0:eff01767de02 | 693 | if ((central_handle >= 0) && (central_handle < m_centrals_in_db_count)) |
bogdanm | 0:eff01767de02 | 694 | { |
bogdanm | 0:eff01767de02 | 695 | // Update the database based on whether the bond and system attributes have |
bogdanm | 0:eff01767de02 | 696 | // been loaded or not to avoid overwriting information that was not used in the |
bogdanm | 0:eff01767de02 | 697 | // connection session. |
bogdanm | 0:eff01767de02 | 698 | if (m_bond_loaded) |
bogdanm | 0:eff01767de02 | 699 | { |
bogdanm | 0:eff01767de02 | 700 | m_centrals_db[central_handle].bond = m_central.bond; |
bogdanm | 0:eff01767de02 | 701 | } |
bogdanm | 0:eff01767de02 | 702 | |
bogdanm | 0:eff01767de02 | 703 | if (m_sys_attr_loaded) |
bogdanm | 0:eff01767de02 | 704 | { |
bogdanm | 0:eff01767de02 | 705 | m_centrals_db[central_handle].sys_attr = m_central.sys_attr; |
bogdanm | 0:eff01767de02 | 706 | } |
bogdanm | 0:eff01767de02 | 707 | |
bogdanm | 0:eff01767de02 | 708 | update_whitelist(); |
bogdanm | 0:eff01767de02 | 709 | |
bogdanm | 0:eff01767de02 | 710 | err_code = NRF_SUCCESS; |
bogdanm | 0:eff01767de02 | 711 | } |
bogdanm | 0:eff01767de02 | 712 | else |
bogdanm | 0:eff01767de02 | 713 | { |
bogdanm | 0:eff01767de02 | 714 | err_code = NRF_ERROR_INTERNAL; |
bogdanm | 0:eff01767de02 | 715 | } |
bogdanm | 0:eff01767de02 | 716 | |
bogdanm | 0:eff01767de02 | 717 | return err_code; |
bogdanm | 0:eff01767de02 | 718 | } |
bogdanm | 0:eff01767de02 | 719 | |
bogdanm | 0:eff01767de02 | 720 | |
bogdanm | 0:eff01767de02 | 721 | /**@brief Function for searching for the central in the database of known centrals. |
bogdanm | 0:eff01767de02 | 722 | * |
bogdanm | 0:eff01767de02 | 723 | * @details If the central is found, the variable m_central will be populated with all the |
bogdanm | 0:eff01767de02 | 724 | * information (Bonding Information and System Attributes) related to that central. |
bogdanm | 0:eff01767de02 | 725 | * |
bogdanm | 0:eff01767de02 | 726 | * @param[in] central_id Central Identifier. |
bogdanm | 0:eff01767de02 | 727 | * @return NRF_SUCCESS on success, otherwise an error code. |
bogdanm | 0:eff01767de02 | 728 | */ |
bogdanm | 0:eff01767de02 | 729 | static uint32_t central_find_in_db(uint16_t central_id) |
bogdanm | 0:eff01767de02 | 730 | { |
bogdanm | 0:eff01767de02 | 731 | int i; |
bogdanm | 0:eff01767de02 | 732 | |
bogdanm | 0:eff01767de02 | 733 | for (i = 0; i < m_centrals_in_db_count; i++) |
bogdanm | 0:eff01767de02 | 734 | { |
bogdanm | 0:eff01767de02 | 735 | if (central_id == m_centrals_db[i].bond.central_id_info.div) |
bogdanm | 0:eff01767de02 | 736 | { |
bogdanm | 0:eff01767de02 | 737 | m_central = m_centrals_db[i]; |
bogdanm | 0:eff01767de02 | 738 | return NRF_SUCCESS; |
bogdanm | 0:eff01767de02 | 739 | } |
bogdanm | 0:eff01767de02 | 740 | } |
bogdanm | 0:eff01767de02 | 741 | |
bogdanm | 0:eff01767de02 | 742 | return NRF_ERROR_NOT_FOUND; |
bogdanm | 0:eff01767de02 | 743 | } |
bogdanm | 0:eff01767de02 | 744 | |
bogdanm | 0:eff01767de02 | 745 | |
bogdanm | 0:eff01767de02 | 746 | /**@brief Function for loading all Bonding Information and System Attributes from flash. |
bogdanm | 0:eff01767de02 | 747 | * |
bogdanm | 0:eff01767de02 | 748 | * @return NRF_SUCCESS on success, otherwise an error code. |
bogdanm | 0:eff01767de02 | 749 | */ |
bogdanm | 0:eff01767de02 | 750 | static uint32_t load_all_from_flash(void) |
bogdanm | 0:eff01767de02 | 751 | { |
bogdanm | 0:eff01767de02 | 752 | uint32_t err_code; |
bogdanm | 0:eff01767de02 | 753 | int i; |
bogdanm | 0:eff01767de02 | 754 | |
bogdanm | 0:eff01767de02 | 755 | m_centrals_in_db_count = 0; |
bogdanm | 0:eff01767de02 | 756 | |
bogdanm | 0:eff01767de02 | 757 | while (m_centrals_in_db_count < BLE_BONDMNGR_MAX_BONDED_CENTRALS) |
bogdanm | 0:eff01767de02 | 758 | { |
bogdanm | 0:eff01767de02 | 759 | central_bond_t central_bond_info; |
bogdanm | 0:eff01767de02 | 760 | int central_handle; |
bogdanm | 0:eff01767de02 | 761 | |
bogdanm | 0:eff01767de02 | 762 | // Load Bonding Information. |
bogdanm | 0:eff01767de02 | 763 | err_code = bonding_info_load_from_flash(¢ral_bond_info); |
bogdanm | 0:eff01767de02 | 764 | if (err_code == NRF_ERROR_NOT_FOUND) |
bogdanm | 0:eff01767de02 | 765 | { |
bogdanm | 0:eff01767de02 | 766 | // No more bonds in flash. |
bogdanm | 0:eff01767de02 | 767 | break; |
bogdanm | 0:eff01767de02 | 768 | } |
bogdanm | 0:eff01767de02 | 769 | else if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 770 | { |
bogdanm | 0:eff01767de02 | 771 | return err_code; |
bogdanm | 0:eff01767de02 | 772 | } |
bogdanm | 0:eff01767de02 | 773 | |
bogdanm | 0:eff01767de02 | 774 | central_handle = central_bond_info.central_handle; |
bogdanm | 0:eff01767de02 | 775 | if (central_handle > m_centrals_in_db_count) |
bogdanm | 0:eff01767de02 | 776 | { |
bogdanm | 0:eff01767de02 | 777 | // Central handle value(s) missing in flash. This should never happen. |
bogdanm | 0:eff01767de02 | 778 | return NRF_ERROR_INVALID_DATA; |
bogdanm | 0:eff01767de02 | 779 | } |
bogdanm | 0:eff01767de02 | 780 | else |
bogdanm | 0:eff01767de02 | 781 | { |
bogdanm | 0:eff01767de02 | 782 | // Add/update Bonding Information in central array. |
bogdanm | 0:eff01767de02 | 783 | m_centrals_db[central_handle].bond = central_bond_info; |
bogdanm | 0:eff01767de02 | 784 | if (central_handle == m_centrals_in_db_count) |
bogdanm | 0:eff01767de02 | 785 | { |
bogdanm | 0:eff01767de02 | 786 | // New central handle, clear System Attributes. |
bogdanm | 0:eff01767de02 | 787 | m_centrals_db[central_handle].sys_attr.sys_attr_size = 0; |
bogdanm | 0:eff01767de02 | 788 | m_centrals_db[central_handle].sys_attr.central_handle = INVALID_CENTRAL_HANDLE; |
bogdanm | 0:eff01767de02 | 789 | m_centrals_in_db_count++; |
bogdanm | 0:eff01767de02 | 790 | } |
bogdanm | 0:eff01767de02 | 791 | else |
bogdanm | 0:eff01767de02 | 792 | { |
bogdanm | 0:eff01767de02 | 793 | // Entry was updated, do nothing. |
bogdanm | 0:eff01767de02 | 794 | } |
bogdanm | 0:eff01767de02 | 795 | } |
bogdanm | 0:eff01767de02 | 796 | } |
bogdanm | 0:eff01767de02 | 797 | |
bogdanm | 0:eff01767de02 | 798 | // Load System Attributes for all previously known centrals. |
bogdanm | 0:eff01767de02 | 799 | for (i = 0; i < m_centrals_in_db_count; i++) |
bogdanm | 0:eff01767de02 | 800 | { |
bogdanm | 0:eff01767de02 | 801 | central_sys_attr_t central_sys_attr; |
bogdanm | 0:eff01767de02 | 802 | |
bogdanm | 0:eff01767de02 | 803 | // Load System Attributes. |
bogdanm | 0:eff01767de02 | 804 | err_code = sys_attr_load_from_flash(¢ral_sys_attr); |
bogdanm | 0:eff01767de02 | 805 | if (err_code == NRF_ERROR_NOT_FOUND) |
bogdanm | 0:eff01767de02 | 806 | { |
bogdanm | 0:eff01767de02 | 807 | // No more System Attributes in flash. |
bogdanm | 0:eff01767de02 | 808 | break; |
bogdanm | 0:eff01767de02 | 809 | } |
bogdanm | 0:eff01767de02 | 810 | else if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 811 | { |
bogdanm | 0:eff01767de02 | 812 | return err_code; |
bogdanm | 0:eff01767de02 | 813 | } |
bogdanm | 0:eff01767de02 | 814 | |
bogdanm | 0:eff01767de02 | 815 | if (central_sys_attr.central_handle > m_centrals_in_db_count) |
bogdanm | 0:eff01767de02 | 816 | { |
bogdanm | 0:eff01767de02 | 817 | // Central handle value(s) missing in flash. This should never happen. |
bogdanm | 0:eff01767de02 | 818 | return NRF_ERROR_INVALID_DATA; |
bogdanm | 0:eff01767de02 | 819 | } |
bogdanm | 0:eff01767de02 | 820 | else |
bogdanm | 0:eff01767de02 | 821 | { |
bogdanm | 0:eff01767de02 | 822 | // Add/update Bonding Information in central array. |
bogdanm | 0:eff01767de02 | 823 | m_centrals_db[central_sys_attr.central_handle].sys_attr = central_sys_attr; |
bogdanm | 0:eff01767de02 | 824 | } |
bogdanm | 0:eff01767de02 | 825 | } |
bogdanm | 0:eff01767de02 | 826 | |
bogdanm | 0:eff01767de02 | 827 | // Initialize the remaining empty bond entries in the memory. |
bogdanm | 0:eff01767de02 | 828 | for (i = m_centrals_in_db_count; i < BLE_BONDMNGR_MAX_BONDED_CENTRALS; i++) |
bogdanm | 0:eff01767de02 | 829 | { |
bogdanm | 0:eff01767de02 | 830 | m_centrals_db[i].bond.central_handle = INVALID_CENTRAL_HANDLE; |
bogdanm | 0:eff01767de02 | 831 | m_centrals_db[i].sys_attr.sys_attr_size = 0; |
bogdanm | 0:eff01767de02 | 832 | m_centrals_db[i].sys_attr.central_handle = INVALID_CENTRAL_HANDLE; |
bogdanm | 0:eff01767de02 | 833 | } |
bogdanm | 0:eff01767de02 | 834 | |
bogdanm | 0:eff01767de02 | 835 | // Update whitelist data structures. |
bogdanm | 0:eff01767de02 | 836 | update_whitelist(); |
bogdanm | 0:eff01767de02 | 837 | |
bogdanm | 0:eff01767de02 | 838 | return NRF_SUCCESS; |
bogdanm | 0:eff01767de02 | 839 | } |
bogdanm | 0:eff01767de02 | 840 | |
bogdanm | 0:eff01767de02 | 841 | |
bogdanm | 0:eff01767de02 | 842 | /**@brief Function for handling the connected event received from the BLE stack. |
bogdanm | 0:eff01767de02 | 843 | * |
bogdanm | 0:eff01767de02 | 844 | * @param[in] p_ble_evt Event received from the BLE stack. |
bogdanm | 0:eff01767de02 | 845 | */ |
bogdanm | 0:eff01767de02 | 846 | static void on_connect(ble_evt_t * p_ble_evt) |
bogdanm | 0:eff01767de02 | 847 | { |
bogdanm | 0:eff01767de02 | 848 | m_conn_handle = p_ble_evt->evt.gap_evt.conn_handle; |
bogdanm | 0:eff01767de02 | 849 | |
bogdanm | 0:eff01767de02 | 850 | m_central.bond.central_handle = INVALID_CENTRAL_HANDLE; |
bogdanm | 0:eff01767de02 | 851 | m_central.bond.central_addr = p_ble_evt->evt.gap_evt.params.connected.peer_addr; |
bogdanm | 0:eff01767de02 | 852 | m_central.sys_attr.sys_attr_size = 0; |
bogdanm | 0:eff01767de02 | 853 | |
bogdanm | 0:eff01767de02 | 854 | if (p_ble_evt->evt.gap_evt.params.connected.irk_match) |
bogdanm | 0:eff01767de02 | 855 | { |
bogdanm | 0:eff01767de02 | 856 | uint8_t irk_idx = p_ble_evt->evt.gap_evt.params.connected.irk_match_idx; |
bogdanm | 0:eff01767de02 | 857 | |
bogdanm | 0:eff01767de02 | 858 | if ((irk_idx >= MAX_NUM_CENTRAL_WHITE_LIST) || |
bogdanm | 0:eff01767de02 | 859 | (m_whitelist_irk[irk_idx].central_handle >= BLE_BONDMNGR_MAX_BONDED_CENTRALS)) |
bogdanm | 0:eff01767de02 | 860 | { |
bogdanm | 0:eff01767de02 | 861 | m_bondmngr_config.error_handler(NRF_ERROR_INTERNAL); |
bogdanm | 0:eff01767de02 | 862 | } |
bogdanm | 0:eff01767de02 | 863 | else |
bogdanm | 0:eff01767de02 | 864 | { |
bogdanm | 0:eff01767de02 | 865 | m_central = m_centrals_db[m_whitelist_irk[irk_idx].central_handle]; |
bogdanm | 0:eff01767de02 | 866 | } |
bogdanm | 0:eff01767de02 | 867 | } |
bogdanm | 0:eff01767de02 | 868 | else |
bogdanm | 0:eff01767de02 | 869 | { |
bogdanm | 0:eff01767de02 | 870 | int i; |
bogdanm | 0:eff01767de02 | 871 | |
bogdanm | 0:eff01767de02 | 872 | for (i = 0; i < m_addr_count; i++) |
bogdanm | 0:eff01767de02 | 873 | { |
bogdanm | 0:eff01767de02 | 874 | ble_gap_addr_t * p_cur_addr = m_whitelist_addr[i].p_addr; |
bogdanm | 0:eff01767de02 | 875 | |
bogdanm | 0:eff01767de02 | 876 | if (memcmp(p_cur_addr->addr, m_central.bond.central_addr.addr, BLE_GAP_ADDR_LEN) == 0) |
bogdanm | 0:eff01767de02 | 877 | { |
bogdanm | 0:eff01767de02 | 878 | m_central = m_centrals_db[m_whitelist_addr[i].central_handle]; |
bogdanm | 0:eff01767de02 | 879 | break; |
bogdanm | 0:eff01767de02 | 880 | } |
bogdanm | 0:eff01767de02 | 881 | } |
bogdanm | 0:eff01767de02 | 882 | } |
bogdanm | 0:eff01767de02 | 883 | |
bogdanm | 0:eff01767de02 | 884 | if (m_central.bond.central_handle != INVALID_CENTRAL_HANDLE) |
bogdanm | 0:eff01767de02 | 885 | { |
bogdanm | 0:eff01767de02 | 886 | // Reset bond and system attributes loaded variables. |
bogdanm | 0:eff01767de02 | 887 | m_bond_loaded = false; |
bogdanm | 0:eff01767de02 | 888 | m_sys_attr_loaded = false; |
bogdanm | 0:eff01767de02 | 889 | |
bogdanm | 0:eff01767de02 | 890 | // Do not set the system attributes of the central on connection. |
bogdanm | 0:eff01767de02 | 891 | if (m_bondmngr_config.evt_handler != NULL) |
bogdanm | 0:eff01767de02 | 892 | { |
bogdanm | 0:eff01767de02 | 893 | ble_bondmngr_evt_t evt; |
bogdanm | 0:eff01767de02 | 894 | |
bogdanm | 0:eff01767de02 | 895 | evt.evt_type = BLE_BONDMNGR_EVT_CONN_TO_BONDED_CENTRAL; |
bogdanm | 0:eff01767de02 | 896 | evt.central_handle = m_central.bond.central_handle; |
bogdanm | 0:eff01767de02 | 897 | evt.central_id = m_central.bond.central_id_info.div; |
bogdanm | 0:eff01767de02 | 898 | |
bogdanm | 0:eff01767de02 | 899 | m_bondmngr_config.evt_handler(&evt); |
bogdanm | 0:eff01767de02 | 900 | } |
bogdanm | 0:eff01767de02 | 901 | } |
bogdanm | 0:eff01767de02 | 902 | } |
bogdanm | 0:eff01767de02 | 903 | |
bogdanm | 0:eff01767de02 | 904 | |
bogdanm | 0:eff01767de02 | 905 | /**@brief Function for handling the 'System Attributes Missing' event received from the |
bogdanm | 0:eff01767de02 | 906 | * SoftDevice. |
bogdanm | 0:eff01767de02 | 907 | * |
bogdanm | 0:eff01767de02 | 908 | * @param[in] p_ble_evt Event received from the BLE stack. |
bogdanm | 0:eff01767de02 | 909 | */ |
bogdanm | 0:eff01767de02 | 910 | static void on_sys_attr_missing(ble_evt_t * p_ble_evt) |
bogdanm | 0:eff01767de02 | 911 | { |
bogdanm | 0:eff01767de02 | 912 | uint32_t err_code; |
bogdanm | 0:eff01767de02 | 913 | |
bogdanm | 0:eff01767de02 | 914 | if ( |
bogdanm | 0:eff01767de02 | 915 | (m_central.bond.central_handle == INVALID_CENTRAL_HANDLE) || |
bogdanm | 0:eff01767de02 | 916 | !ENCRYPTION_STATUS_GET() || |
bogdanm | 0:eff01767de02 | 917 | BONDING_IN_PROGRESS_STATUS_GET() |
bogdanm | 0:eff01767de02 | 918 | ) |
bogdanm | 0:eff01767de02 | 919 | { |
bogdanm | 0:eff01767de02 | 920 | err_code = sd_ble_gatts_sys_attr_set(m_conn_handle, NULL, 0); |
bogdanm | 0:eff01767de02 | 921 | } |
bogdanm | 0:eff01767de02 | 922 | else |
bogdanm | 0:eff01767de02 | 923 | { |
bogdanm | 0:eff01767de02 | 924 | // Current central is valid, use its data. Set the corresponding sys_attr. |
bogdanm | 0:eff01767de02 | 925 | err_code = central_sys_attr_set(&m_central); |
bogdanm | 0:eff01767de02 | 926 | if (err_code == NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 927 | { |
bogdanm | 0:eff01767de02 | 928 | // Set System Attributes loaded status variable. |
bogdanm | 0:eff01767de02 | 929 | m_sys_attr_loaded = true; |
bogdanm | 0:eff01767de02 | 930 | } |
bogdanm | 0:eff01767de02 | 931 | } |
bogdanm | 0:eff01767de02 | 932 | |
bogdanm | 0:eff01767de02 | 933 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 934 | { |
bogdanm | 0:eff01767de02 | 935 | m_bondmngr_config.error_handler(err_code); |
bogdanm | 0:eff01767de02 | 936 | } |
bogdanm | 0:eff01767de02 | 937 | } |
bogdanm | 0:eff01767de02 | 938 | |
bogdanm | 0:eff01767de02 | 939 | |
bogdanm | 0:eff01767de02 | 940 | /**@brief Function for handling the new authentication status event, received from the |
bogdanm | 0:eff01767de02 | 941 | * SoftDevice, related to an already bonded central. |
bogdanm | 0:eff01767de02 | 942 | * |
bogdanm | 0:eff01767de02 | 943 | * @details This function also writes the updated Bonding Information to flash and notifies the |
bogdanm | 0:eff01767de02 | 944 | * application. |
bogdanm | 0:eff01767de02 | 945 | * |
bogdanm | 0:eff01767de02 | 946 | * @param[in] p_auth_status Updated authentication status. |
bogdanm | 0:eff01767de02 | 947 | */ |
bogdanm | 0:eff01767de02 | 948 | static void auth_status_update(ble_gap_evt_auth_status_t * p_auth_status) |
bogdanm | 0:eff01767de02 | 949 | { |
bogdanm | 0:eff01767de02 | 950 | uint32_t err_code; |
bogdanm | 0:eff01767de02 | 951 | |
bogdanm | 0:eff01767de02 | 952 | // Authentication status changed, update Bonding Information. |
bogdanm | 0:eff01767de02 | 953 | m_central.bond.auth_status = *p_auth_status; |
bogdanm | 0:eff01767de02 | 954 | m_central.bond.central_id_info.div = p_auth_status->periph_keys.enc_info.div; |
bogdanm | 0:eff01767de02 | 955 | |
bogdanm | 0:eff01767de02 | 956 | memset(&(m_centrals_db[m_central.bond.central_handle]), 0, sizeof(central_t)); |
bogdanm | 0:eff01767de02 | 957 | m_centrals_db[m_central.bond.central_handle] = m_central; |
bogdanm | 0:eff01767de02 | 958 | |
bogdanm | 0:eff01767de02 | 959 | // Write updated Bonding Information to flash. |
bogdanm | 0:eff01767de02 | 960 | err_code = bond_info_store(&m_central.bond); |
bogdanm | 0:eff01767de02 | 961 | if ((err_code == NRF_ERROR_NO_MEM) && (m_bondmngr_config.evt_handler != NULL)) |
bogdanm | 0:eff01767de02 | 962 | { |
bogdanm | 0:eff01767de02 | 963 | ble_bondmngr_evt_t evt; |
bogdanm | 0:eff01767de02 | 964 | |
bogdanm | 0:eff01767de02 | 965 | evt.evt_type = BLE_BONDMNGR_EVT_BOND_FLASH_FULL; |
bogdanm | 0:eff01767de02 | 966 | evt.central_handle = m_central.bond.central_handle; |
bogdanm | 0:eff01767de02 | 967 | evt.central_id = m_central.bond.central_id_info.div; |
bogdanm | 0:eff01767de02 | 968 | |
bogdanm | 0:eff01767de02 | 969 | m_bondmngr_config.evt_handler(&evt); |
bogdanm | 0:eff01767de02 | 970 | } |
bogdanm | 0:eff01767de02 | 971 | else if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 972 | { |
bogdanm | 0:eff01767de02 | 973 | m_bondmngr_config.error_handler(err_code); |
bogdanm | 0:eff01767de02 | 974 | } |
bogdanm | 0:eff01767de02 | 975 | |
bogdanm | 0:eff01767de02 | 976 | // Pass the event to the application. |
bogdanm | 0:eff01767de02 | 977 | if (m_bondmngr_config.evt_handler != NULL) |
bogdanm | 0:eff01767de02 | 978 | { |
bogdanm | 0:eff01767de02 | 979 | ble_bondmngr_evt_t evt; |
bogdanm | 0:eff01767de02 | 980 | |
bogdanm | 0:eff01767de02 | 981 | evt.evt_type = BLE_BONDMNGR_EVT_AUTH_STATUS_UPDATED; |
bogdanm | 0:eff01767de02 | 982 | evt.central_handle = m_central.bond.central_handle; |
bogdanm | 0:eff01767de02 | 983 | evt.central_id = m_central.bond.central_id_info.div; |
bogdanm | 0:eff01767de02 | 984 | |
bogdanm | 0:eff01767de02 | 985 | m_bondmngr_config.evt_handler(&evt); |
bogdanm | 0:eff01767de02 | 986 | } |
bogdanm | 0:eff01767de02 | 987 | } |
bogdanm | 0:eff01767de02 | 988 | |
bogdanm | 0:eff01767de02 | 989 | |
bogdanm | 0:eff01767de02 | 990 | /**@brief Function for handling the Authentication Status event received from the BLE stack. |
bogdanm | 0:eff01767de02 | 991 | * |
bogdanm | 0:eff01767de02 | 992 | * @param[in] p_ble_evt Event received from the BLE stack. |
bogdanm | 0:eff01767de02 | 993 | */ |
bogdanm | 0:eff01767de02 | 994 | static void on_auth_status(ble_gap_evt_auth_status_t * p_auth_status) |
bogdanm | 0:eff01767de02 | 995 | { |
bogdanm | 0:eff01767de02 | 996 | if (p_auth_status->auth_status != BLE_GAP_SEC_STATUS_SUCCESS) |
bogdanm | 0:eff01767de02 | 997 | { |
bogdanm | 0:eff01767de02 | 998 | return; |
bogdanm | 0:eff01767de02 | 999 | } |
bogdanm | 0:eff01767de02 | 1000 | |
bogdanm | 0:eff01767de02 | 1001 | // Verify if its pairing and not bonding |
bogdanm | 0:eff01767de02 | 1002 | if (!ENCRYPTION_STATUS_GET()) |
bogdanm | 0:eff01767de02 | 1003 | { |
bogdanm | 0:eff01767de02 | 1004 | return; |
bogdanm | 0:eff01767de02 | 1005 | } |
bogdanm | 0:eff01767de02 | 1006 | |
bogdanm | 0:eff01767de02 | 1007 | if (m_central.bond.central_handle == INVALID_CENTRAL_HANDLE) |
bogdanm | 0:eff01767de02 | 1008 | { |
bogdanm | 0:eff01767de02 | 1009 | uint32_t err_code = central_find_in_db(p_auth_status->periph_keys.enc_info.div); |
bogdanm | 0:eff01767de02 | 1010 | |
bogdanm | 0:eff01767de02 | 1011 | if (err_code == NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1012 | { |
bogdanm | 0:eff01767de02 | 1013 | // Possible DIV Collision indicate error to application, |
bogdanm | 0:eff01767de02 | 1014 | // not storing the new LTK |
bogdanm | 0:eff01767de02 | 1015 | err_code = NRF_ERROR_FORBIDDEN; |
bogdanm | 0:eff01767de02 | 1016 | } |
bogdanm | 0:eff01767de02 | 1017 | else |
bogdanm | 0:eff01767de02 | 1018 | { |
bogdanm | 0:eff01767de02 | 1019 | // Add the new device to data base |
bogdanm | 0:eff01767de02 | 1020 | err_code = on_auth_status_from_new_central(p_auth_status); |
bogdanm | 0:eff01767de02 | 1021 | } |
bogdanm | 0:eff01767de02 | 1022 | |
bogdanm | 0:eff01767de02 | 1023 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1024 | { |
bogdanm | 0:eff01767de02 | 1025 | m_bondmngr_config.error_handler(err_code); |
bogdanm | 0:eff01767de02 | 1026 | } |
bogdanm | 0:eff01767de02 | 1027 | } |
bogdanm | 0:eff01767de02 | 1028 | else |
bogdanm | 0:eff01767de02 | 1029 | { |
bogdanm | 0:eff01767de02 | 1030 | m_bond_loaded = true; |
bogdanm | 0:eff01767de02 | 1031 | |
bogdanm | 0:eff01767de02 | 1032 | // Receiving a auth status again when already in have existing information! |
bogdanm | 0:eff01767de02 | 1033 | auth_status_update(p_auth_status); |
bogdanm | 0:eff01767de02 | 1034 | } |
bogdanm | 0:eff01767de02 | 1035 | } |
bogdanm | 0:eff01767de02 | 1036 | |
bogdanm | 0:eff01767de02 | 1037 | |
bogdanm | 0:eff01767de02 | 1038 | /**@brief Function for handling the Security Info Request event received from the BLE stack. |
bogdanm | 0:eff01767de02 | 1039 | * |
bogdanm | 0:eff01767de02 | 1040 | * @param[in] p_ble_evt Event received from the BLE stack. |
bogdanm | 0:eff01767de02 | 1041 | */ |
bogdanm | 0:eff01767de02 | 1042 | static void on_sec_info_request(ble_evt_t * p_ble_evt) |
bogdanm | 0:eff01767de02 | 1043 | { |
bogdanm | 0:eff01767de02 | 1044 | uint32_t err_code; |
bogdanm | 0:eff01767de02 | 1045 | |
bogdanm | 0:eff01767de02 | 1046 | err_code = central_find_in_db(p_ble_evt->evt.gap_evt.params.sec_info_request.div); |
bogdanm | 0:eff01767de02 | 1047 | if (err_code == NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1048 | { |
bogdanm | 0:eff01767de02 | 1049 | // Bond information has been found and loaded for security procedures. Reflect this in the |
bogdanm | 0:eff01767de02 | 1050 | // status variable |
bogdanm | 0:eff01767de02 | 1051 | m_bond_loaded = true; |
bogdanm | 0:eff01767de02 | 1052 | |
bogdanm | 0:eff01767de02 | 1053 | // Central found in the list of bonded central. Use the encryption info for this central. |
bogdanm | 0:eff01767de02 | 1054 | err_code = sd_ble_gap_sec_info_reply(m_conn_handle, |
bogdanm | 0:eff01767de02 | 1055 | &m_central.bond.auth_status.periph_keys.enc_info, |
bogdanm | 0:eff01767de02 | 1056 | NULL); |
bogdanm | 0:eff01767de02 | 1057 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1058 | { |
bogdanm | 0:eff01767de02 | 1059 | m_bondmngr_config.error_handler(err_code); |
bogdanm | 0:eff01767de02 | 1060 | } |
bogdanm | 0:eff01767de02 | 1061 | |
bogdanm | 0:eff01767de02 | 1062 | // Do not set the sys_attr yet, should be set only when sec_update is successful. |
bogdanm | 0:eff01767de02 | 1063 | } |
bogdanm | 0:eff01767de02 | 1064 | else if (err_code == NRF_ERROR_NOT_FOUND) |
bogdanm | 0:eff01767de02 | 1065 | { |
bogdanm | 0:eff01767de02 | 1066 | m_central.bond.central_id_info = p_ble_evt->evt.gap_evt.params.sec_info_request; |
bogdanm | 0:eff01767de02 | 1067 | |
bogdanm | 0:eff01767de02 | 1068 | // New central. |
bogdanm | 0:eff01767de02 | 1069 | err_code = sd_ble_gap_sec_info_reply(m_conn_handle, NULL, NULL); |
bogdanm | 0:eff01767de02 | 1070 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1071 | { |
bogdanm | 0:eff01767de02 | 1072 | m_bondmngr_config.error_handler(err_code); |
bogdanm | 0:eff01767de02 | 1073 | } |
bogdanm | 0:eff01767de02 | 1074 | |
bogdanm | 0:eff01767de02 | 1075 | // Initialize the sys_attr. |
bogdanm | 0:eff01767de02 | 1076 | err_code = sd_ble_gatts_sys_attr_set(m_conn_handle, NULL, 0); |
bogdanm | 0:eff01767de02 | 1077 | } |
bogdanm | 0:eff01767de02 | 1078 | |
bogdanm | 0:eff01767de02 | 1079 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1080 | { |
bogdanm | 0:eff01767de02 | 1081 | m_bondmngr_config.error_handler(err_code); |
bogdanm | 0:eff01767de02 | 1082 | } |
bogdanm | 0:eff01767de02 | 1083 | } |
bogdanm | 0:eff01767de02 | 1084 | |
bogdanm | 0:eff01767de02 | 1085 | |
bogdanm | 0:eff01767de02 | 1086 | /**@brief Function for handling the Connection Security Update event received from the BLE |
bogdanm | 0:eff01767de02 | 1087 | * stack. |
bogdanm | 0:eff01767de02 | 1088 | * |
bogdanm | 0:eff01767de02 | 1089 | * @param[in] p_ble_evt Event received from the BLE stack. |
bogdanm | 0:eff01767de02 | 1090 | */ |
bogdanm | 0:eff01767de02 | 1091 | static void on_sec_update(ble_gap_evt_conn_sec_update_t * p_sec_update) |
bogdanm | 0:eff01767de02 | 1092 | { |
bogdanm | 0:eff01767de02 | 1093 | uint8_t security_mode = p_sec_update->conn_sec.sec_mode.sm; |
bogdanm | 0:eff01767de02 | 1094 | uint8_t security_level = p_sec_update->conn_sec.sec_mode.lv; |
bogdanm | 0:eff01767de02 | 1095 | |
bogdanm | 0:eff01767de02 | 1096 | if (((security_mode == 1) && (security_level > 1)) || |
bogdanm | 0:eff01767de02 | 1097 | ((security_mode == 2) && (security_level != 0))) |
bogdanm | 0:eff01767de02 | 1098 | { |
bogdanm | 0:eff01767de02 | 1099 | ENCRYPTION_STATUS_SET(); |
bogdanm | 0:eff01767de02 | 1100 | |
bogdanm | 0:eff01767de02 | 1101 | uint32_t err_code = central_sys_attr_set(&m_central); |
bogdanm | 0:eff01767de02 | 1102 | |
bogdanm | 0:eff01767de02 | 1103 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1104 | { |
bogdanm | 0:eff01767de02 | 1105 | m_bondmngr_config.error_handler(err_code); |
bogdanm | 0:eff01767de02 | 1106 | } |
bogdanm | 0:eff01767de02 | 1107 | else |
bogdanm | 0:eff01767de02 | 1108 | { |
bogdanm | 0:eff01767de02 | 1109 | m_sys_attr_loaded = true; |
bogdanm | 0:eff01767de02 | 1110 | } |
bogdanm | 0:eff01767de02 | 1111 | |
bogdanm | 0:eff01767de02 | 1112 | if (m_bondmngr_config.evt_handler != NULL) |
bogdanm | 0:eff01767de02 | 1113 | { |
bogdanm | 0:eff01767de02 | 1114 | ble_bondmngr_evt_t evt; |
bogdanm | 0:eff01767de02 | 1115 | |
bogdanm | 0:eff01767de02 | 1116 | evt.evt_type = BLE_BONDMNGR_EVT_ENCRYPTED; |
bogdanm | 0:eff01767de02 | 1117 | evt.central_handle = m_central.bond.central_handle; |
bogdanm | 0:eff01767de02 | 1118 | evt.central_id = m_central.bond.central_id_info.div; |
bogdanm | 0:eff01767de02 | 1119 | |
bogdanm | 0:eff01767de02 | 1120 | m_bondmngr_config.evt_handler(&evt); |
bogdanm | 0:eff01767de02 | 1121 | } |
bogdanm | 0:eff01767de02 | 1122 | } |
bogdanm | 0:eff01767de02 | 1123 | } |
bogdanm | 0:eff01767de02 | 1124 | |
bogdanm | 0:eff01767de02 | 1125 | |
bogdanm | 0:eff01767de02 | 1126 | /**@brief Function for handling the Connection Security Parameters Request event received from |
bogdanm | 0:eff01767de02 | 1127 | * the BLE stack. |
bogdanm | 0:eff01767de02 | 1128 | * |
bogdanm | 0:eff01767de02 | 1129 | * @param[in] p_ble_evt Event received from the BLE stack. |
bogdanm | 0:eff01767de02 | 1130 | */ |
bogdanm | 0:eff01767de02 | 1131 | static void on_sec_param_request(ble_gap_evt_sec_params_request_t * p_sec_update) |
bogdanm | 0:eff01767de02 | 1132 | { |
bogdanm | 0:eff01767de02 | 1133 | if (p_sec_update->peer_params.bond) |
bogdanm | 0:eff01767de02 | 1134 | { |
bogdanm | 0:eff01767de02 | 1135 | BONDING_IN_PROGRESS_STATUS_SET(); |
bogdanm | 0:eff01767de02 | 1136 | |
bogdanm | 0:eff01767de02 | 1137 | if (m_central.bond.central_handle != INVALID_CENTRAL_HANDLE) |
bogdanm | 0:eff01767de02 | 1138 | { |
bogdanm | 0:eff01767de02 | 1139 | // Bonding request received from a bonded central, make all system attributes null |
bogdanm | 0:eff01767de02 | 1140 | m_central.sys_attr.sys_attr_size = 0; |
bogdanm | 0:eff01767de02 | 1141 | memset(m_central.sys_attr.sys_attr, 0, SYS_ATTR_BUFFER_MAX_LEN); |
bogdanm | 0:eff01767de02 | 1142 | } |
bogdanm | 0:eff01767de02 | 1143 | } |
bogdanm | 0:eff01767de02 | 1144 | } |
bogdanm | 0:eff01767de02 | 1145 | |
bogdanm | 0:eff01767de02 | 1146 | |
bogdanm | 0:eff01767de02 | 1147 | void ble_bondmngr_on_ble_evt(ble_evt_t * p_ble_evt) |
bogdanm | 0:eff01767de02 | 1148 | { |
bogdanm | 0:eff01767de02 | 1149 | if (!m_is_bondmngr_initialized) |
bogdanm | 0:eff01767de02 | 1150 | { |
bogdanm | 0:eff01767de02 | 1151 | m_bondmngr_config.error_handler(NRF_ERROR_INVALID_STATE); |
bogdanm | 0:eff01767de02 | 1152 | } |
bogdanm | 0:eff01767de02 | 1153 | |
bogdanm | 0:eff01767de02 | 1154 | switch (p_ble_evt->header.evt_id) |
bogdanm | 0:eff01767de02 | 1155 | { |
bogdanm | 0:eff01767de02 | 1156 | case BLE_GAP_EVT_CONNECTED: |
bogdanm | 0:eff01767de02 | 1157 | on_connect(p_ble_evt); |
bogdanm | 0:eff01767de02 | 1158 | break; |
bogdanm | 0:eff01767de02 | 1159 | |
bogdanm | 0:eff01767de02 | 1160 | // NOTE: All actions to be taken on the Disconnected event are performed in |
bogdanm | 0:eff01767de02 | 1161 | // ble_bondmngr_bonded_centrals_store(). This function must be called from the |
bogdanm | 0:eff01767de02 | 1162 | // Disconnected handler of the application before advertising is restarted (to make |
bogdanm | 0:eff01767de02 | 1163 | // sure the flash blocks are cleared while the radio is inactive). |
bogdanm | 0:eff01767de02 | 1164 | case BLE_GAP_EVT_DISCONNECTED: |
bogdanm | 0:eff01767de02 | 1165 | SECURITY_STATUS_RESET(); |
bogdanm | 0:eff01767de02 | 1166 | break; |
bogdanm | 0:eff01767de02 | 1167 | |
bogdanm | 0:eff01767de02 | 1168 | case BLE_GATTS_EVT_SYS_ATTR_MISSING: |
bogdanm | 0:eff01767de02 | 1169 | on_sys_attr_missing(p_ble_evt); |
bogdanm | 0:eff01767de02 | 1170 | break; |
bogdanm | 0:eff01767de02 | 1171 | |
bogdanm | 0:eff01767de02 | 1172 | case BLE_GAP_EVT_AUTH_STATUS: |
bogdanm | 0:eff01767de02 | 1173 | on_auth_status(&p_ble_evt->evt.gap_evt.params.auth_status); |
bogdanm | 0:eff01767de02 | 1174 | break; |
bogdanm | 0:eff01767de02 | 1175 | |
bogdanm | 0:eff01767de02 | 1176 | case BLE_GAP_EVT_SEC_INFO_REQUEST: |
bogdanm | 0:eff01767de02 | 1177 | on_sec_info_request(p_ble_evt); |
bogdanm | 0:eff01767de02 | 1178 | break; |
bogdanm | 0:eff01767de02 | 1179 | |
bogdanm | 0:eff01767de02 | 1180 | case BLE_GAP_EVT_SEC_PARAMS_REQUEST: |
bogdanm | 0:eff01767de02 | 1181 | on_sec_param_request(&p_ble_evt->evt.gap_evt.params.sec_params_request); |
bogdanm | 0:eff01767de02 | 1182 | break; |
bogdanm | 0:eff01767de02 | 1183 | |
bogdanm | 0:eff01767de02 | 1184 | case BLE_GAP_EVT_CONN_SEC_UPDATE: |
bogdanm | 0:eff01767de02 | 1185 | on_sec_update(&p_ble_evt->evt.gap_evt.params.conn_sec_update); |
bogdanm | 0:eff01767de02 | 1186 | break; |
bogdanm | 0:eff01767de02 | 1187 | |
bogdanm | 0:eff01767de02 | 1188 | default: |
bogdanm | 0:eff01767de02 | 1189 | // No implementation needed. |
bogdanm | 0:eff01767de02 | 1190 | break; |
bogdanm | 0:eff01767de02 | 1191 | } |
bogdanm | 0:eff01767de02 | 1192 | } |
bogdanm | 0:eff01767de02 | 1193 | |
bogdanm | 0:eff01767de02 | 1194 | |
bogdanm | 0:eff01767de02 | 1195 | uint32_t ble_bondmngr_bonded_centrals_store(void) |
bogdanm | 0:eff01767de02 | 1196 | { |
bogdanm | 0:eff01767de02 | 1197 | uint32_t err_code; |
bogdanm | 0:eff01767de02 | 1198 | int i; |
bogdanm | 0:eff01767de02 | 1199 | |
bogdanm | 0:eff01767de02 | 1200 | VERIFY_MODULE_INITIALIZED(); |
bogdanm | 0:eff01767de02 | 1201 | |
bogdanm | 0:eff01767de02 | 1202 | if (m_central.bond.central_handle != INVALID_CENTRAL_HANDLE) |
bogdanm | 0:eff01767de02 | 1203 | { |
bogdanm | 0:eff01767de02 | 1204 | // Fetch System Attributes from stack. |
bogdanm | 0:eff01767de02 | 1205 | uint16_t sys_attr_size = SYS_ATTR_BUFFER_MAX_LEN; |
bogdanm | 0:eff01767de02 | 1206 | |
bogdanm | 0:eff01767de02 | 1207 | err_code = sd_ble_gatts_sys_attr_get(m_conn_handle, |
bogdanm | 0:eff01767de02 | 1208 | m_central.sys_attr.sys_attr, |
bogdanm | 0:eff01767de02 | 1209 | &sys_attr_size); |
bogdanm | 0:eff01767de02 | 1210 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1211 | { |
bogdanm | 0:eff01767de02 | 1212 | return err_code; |
bogdanm | 0:eff01767de02 | 1213 | } |
bogdanm | 0:eff01767de02 | 1214 | |
bogdanm | 0:eff01767de02 | 1215 | m_central.sys_attr.central_handle = m_central.bond.central_handle; |
bogdanm | 0:eff01767de02 | 1216 | m_central.sys_attr.sys_attr_size = (uint16_t)sys_attr_size; |
bogdanm | 0:eff01767de02 | 1217 | |
bogdanm | 0:eff01767de02 | 1218 | // Update the current central. |
bogdanm | 0:eff01767de02 | 1219 | err_code = central_update(); |
bogdanm | 0:eff01767de02 | 1220 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1221 | { |
bogdanm | 0:eff01767de02 | 1222 | return err_code; |
bogdanm | 0:eff01767de02 | 1223 | } |
bogdanm | 0:eff01767de02 | 1224 | } |
bogdanm | 0:eff01767de02 | 1225 | |
bogdanm | 0:eff01767de02 | 1226 | // Save Bonding Information if changed. |
bogdanm | 0:eff01767de02 | 1227 | if (bond_info_changed()) |
bogdanm | 0:eff01767de02 | 1228 | { |
bogdanm | 0:eff01767de02 | 1229 | // Erase flash page. |
bogdanm | 0:eff01767de02 | 1230 | err_code = pstorage_clear(&mp_flash_bond_info,MAX_BONDS_IN_FLASH); |
bogdanm | 0:eff01767de02 | 1231 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1232 | { |
bogdanm | 0:eff01767de02 | 1233 | return err_code; |
bogdanm | 0:eff01767de02 | 1234 | } |
bogdanm | 0:eff01767de02 | 1235 | |
bogdanm | 0:eff01767de02 | 1236 | // Store bond information for all centrals. |
bogdanm | 0:eff01767de02 | 1237 | m_bond_info_in_flash_count = 0; |
bogdanm | 0:eff01767de02 | 1238 | for (i = 0; i < m_centrals_in_db_count; i++) |
bogdanm | 0:eff01767de02 | 1239 | { |
bogdanm | 0:eff01767de02 | 1240 | err_code = bond_info_store(&m_centrals_db[i].bond); |
bogdanm | 0:eff01767de02 | 1241 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1242 | { |
bogdanm | 0:eff01767de02 | 1243 | return err_code; |
bogdanm | 0:eff01767de02 | 1244 | } |
bogdanm | 0:eff01767de02 | 1245 | } |
bogdanm | 0:eff01767de02 | 1246 | } |
bogdanm | 0:eff01767de02 | 1247 | |
bogdanm | 0:eff01767de02 | 1248 | // Save System Attributes, if changed. |
bogdanm | 0:eff01767de02 | 1249 | if (sys_attr_changed()) |
bogdanm | 0:eff01767de02 | 1250 | { |
bogdanm | 0:eff01767de02 | 1251 | // Erase flash page. |
bogdanm | 0:eff01767de02 | 1252 | err_code = pstorage_clear(&mp_flash_sys_attr, MAX_BONDS_IN_FLASH); |
bogdanm | 0:eff01767de02 | 1253 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1254 | { |
bogdanm | 0:eff01767de02 | 1255 | return err_code; |
bogdanm | 0:eff01767de02 | 1256 | } |
bogdanm | 0:eff01767de02 | 1257 | |
bogdanm | 0:eff01767de02 | 1258 | // Store System Attributes for all centrals. |
bogdanm | 0:eff01767de02 | 1259 | m_sys_attr_in_flash_count = 0; |
bogdanm | 0:eff01767de02 | 1260 | for (i = 0; i < m_centrals_in_db_count; i++) |
bogdanm | 0:eff01767de02 | 1261 | { |
bogdanm | 0:eff01767de02 | 1262 | err_code = sys_attr_store(&m_centrals_db[i].sys_attr); |
bogdanm | 0:eff01767de02 | 1263 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1264 | { |
bogdanm | 0:eff01767de02 | 1265 | return err_code; |
bogdanm | 0:eff01767de02 | 1266 | } |
bogdanm | 0:eff01767de02 | 1267 | } |
bogdanm | 0:eff01767de02 | 1268 | } |
bogdanm | 0:eff01767de02 | 1269 | |
bogdanm | 0:eff01767de02 | 1270 | m_conn_handle = BLE_CONN_HANDLE_INVALID; |
bogdanm | 0:eff01767de02 | 1271 | m_central.bond.central_handle = INVALID_CENTRAL_HANDLE; |
bogdanm | 0:eff01767de02 | 1272 | m_central.sys_attr.central_handle = INVALID_CENTRAL_HANDLE; |
bogdanm | 0:eff01767de02 | 1273 | m_central.sys_attr.sys_attr_size = 0; |
bogdanm | 0:eff01767de02 | 1274 | m_bond_loaded = false; |
bogdanm | 0:eff01767de02 | 1275 | m_sys_attr_loaded = false; |
bogdanm | 0:eff01767de02 | 1276 | |
bogdanm | 0:eff01767de02 | 1277 | return NRF_SUCCESS; |
bogdanm | 0:eff01767de02 | 1278 | } |
bogdanm | 0:eff01767de02 | 1279 | |
bogdanm | 0:eff01767de02 | 1280 | |
bogdanm | 0:eff01767de02 | 1281 | uint32_t ble_bondmngr_sys_attr_store(void) |
bogdanm | 0:eff01767de02 | 1282 | { |
bogdanm | 0:eff01767de02 | 1283 | uint32_t err_code; |
bogdanm | 0:eff01767de02 | 1284 | |
bogdanm | 0:eff01767de02 | 1285 | if (m_central.sys_attr.sys_attr_size == 0) |
bogdanm | 0:eff01767de02 | 1286 | { |
bogdanm | 0:eff01767de02 | 1287 | // Connected to new central. So the flash block for System Attributes for this |
bogdanm | 0:eff01767de02 | 1288 | // central is empty. Hence no erase is needed. |
bogdanm | 0:eff01767de02 | 1289 | |
bogdanm | 0:eff01767de02 | 1290 | uint16_t sys_attr_size = SYS_ATTR_BUFFER_MAX_LEN; |
bogdanm | 0:eff01767de02 | 1291 | |
bogdanm | 0:eff01767de02 | 1292 | // Fetch System Attributes from stack. |
bogdanm | 0:eff01767de02 | 1293 | err_code = sd_ble_gatts_sys_attr_get(m_conn_handle, |
bogdanm | 0:eff01767de02 | 1294 | m_central.sys_attr.sys_attr, |
bogdanm | 0:eff01767de02 | 1295 | &sys_attr_size); |
bogdanm | 0:eff01767de02 | 1296 | |
bogdanm | 0:eff01767de02 | 1297 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1298 | { |
bogdanm | 0:eff01767de02 | 1299 | return err_code; |
bogdanm | 0:eff01767de02 | 1300 | } |
bogdanm | 0:eff01767de02 | 1301 | |
bogdanm | 0:eff01767de02 | 1302 | m_central.sys_attr.central_handle = m_central.bond.central_handle; |
bogdanm | 0:eff01767de02 | 1303 | m_central.sys_attr.sys_attr_size = (uint16_t)sys_attr_size; |
bogdanm | 0:eff01767de02 | 1304 | |
bogdanm | 0:eff01767de02 | 1305 | // Copy the System Attributes to database. |
bogdanm | 0:eff01767de02 | 1306 | m_centrals_db[m_central.bond.central_handle].sys_attr = m_central.sys_attr; |
bogdanm | 0:eff01767de02 | 1307 | |
bogdanm | 0:eff01767de02 | 1308 | // Write new central's System Attributes to flash. |
bogdanm | 0:eff01767de02 | 1309 | return (sys_attr_store(&m_central.sys_attr)); |
bogdanm | 0:eff01767de02 | 1310 | } |
bogdanm | 0:eff01767de02 | 1311 | else |
bogdanm | 0:eff01767de02 | 1312 | { |
bogdanm | 0:eff01767de02 | 1313 | // Will not write to flash because System Attributes of an old central would already be |
bogdanm | 0:eff01767de02 | 1314 | // in flash and so this operation needs a flash erase operation. |
bogdanm | 0:eff01767de02 | 1315 | return NRF_ERROR_INVALID_STATE; |
bogdanm | 0:eff01767de02 | 1316 | } |
bogdanm | 0:eff01767de02 | 1317 | } |
bogdanm | 0:eff01767de02 | 1318 | |
bogdanm | 0:eff01767de02 | 1319 | |
bogdanm | 0:eff01767de02 | 1320 | uint32_t ble_bondmngr_bonded_centrals_delete(void) |
bogdanm | 0:eff01767de02 | 1321 | { |
bogdanm | 0:eff01767de02 | 1322 | VERIFY_MODULE_INITIALIZED(); |
bogdanm | 0:eff01767de02 | 1323 | |
bogdanm | 0:eff01767de02 | 1324 | m_centrals_in_db_count = 0; |
bogdanm | 0:eff01767de02 | 1325 | m_bond_info_in_flash_count = 0; |
bogdanm | 0:eff01767de02 | 1326 | m_sys_attr_in_flash_count = 0; |
bogdanm | 0:eff01767de02 | 1327 | |
bogdanm | 0:eff01767de02 | 1328 | return flash_pages_erase(); |
bogdanm | 0:eff01767de02 | 1329 | } |
bogdanm | 0:eff01767de02 | 1330 | |
bogdanm | 0:eff01767de02 | 1331 | |
bogdanm | 0:eff01767de02 | 1332 | uint32_t ble_bondmngr_central_addr_get(int8_t central_handle, ble_gap_addr_t * p_central_addr) |
bogdanm | 0:eff01767de02 | 1333 | { |
bogdanm | 0:eff01767de02 | 1334 | if ( |
bogdanm | 0:eff01767de02 | 1335 | (central_handle == INVALID_CENTRAL_HANDLE) || |
bogdanm | 0:eff01767de02 | 1336 | (central_handle >= m_centrals_in_db_count) || |
bogdanm | 0:eff01767de02 | 1337 | (p_central_addr == NULL) || |
bogdanm | 0:eff01767de02 | 1338 | ( |
bogdanm | 0:eff01767de02 | 1339 | m_centrals_db[central_handle].bond.central_addr.addr_type |
bogdanm | 0:eff01767de02 | 1340 | == |
bogdanm | 0:eff01767de02 | 1341 | BLE_GAP_ADDR_TYPE_RANDOM_PRIVATE_RESOLVABLE |
bogdanm | 0:eff01767de02 | 1342 | ) |
bogdanm | 0:eff01767de02 | 1343 | ) |
bogdanm | 0:eff01767de02 | 1344 | { |
bogdanm | 0:eff01767de02 | 1345 | return NRF_ERROR_INVALID_PARAM; |
bogdanm | 0:eff01767de02 | 1346 | } |
bogdanm | 0:eff01767de02 | 1347 | |
bogdanm | 0:eff01767de02 | 1348 | *p_central_addr = m_centrals_db[central_handle].bond.central_addr; |
bogdanm | 0:eff01767de02 | 1349 | return NRF_SUCCESS; |
bogdanm | 0:eff01767de02 | 1350 | } |
bogdanm | 0:eff01767de02 | 1351 | |
bogdanm | 0:eff01767de02 | 1352 | |
bogdanm | 0:eff01767de02 | 1353 | uint32_t ble_bondmngr_whitelist_get(ble_gap_whitelist_t * p_whitelist) |
bogdanm | 0:eff01767de02 | 1354 | { |
bogdanm | 0:eff01767de02 | 1355 | static ble_gap_addr_t * s_addr[MAX_NUM_CENTRAL_WHITE_LIST]; |
bogdanm | 0:eff01767de02 | 1356 | static ble_gap_irk_t * s_irk[MAX_NUM_CENTRAL_WHITE_LIST]; |
bogdanm | 0:eff01767de02 | 1357 | |
bogdanm | 0:eff01767de02 | 1358 | int i; |
bogdanm | 0:eff01767de02 | 1359 | |
bogdanm | 0:eff01767de02 | 1360 | for (i = 0; i < m_irk_count; i++) |
bogdanm | 0:eff01767de02 | 1361 | { |
bogdanm | 0:eff01767de02 | 1362 | s_irk[i] = m_whitelist_irk[i].p_irk; |
bogdanm | 0:eff01767de02 | 1363 | } |
bogdanm | 0:eff01767de02 | 1364 | for (i = 0; i < m_addr_count; i++) |
bogdanm | 0:eff01767de02 | 1365 | { |
bogdanm | 0:eff01767de02 | 1366 | s_addr[i] = m_whitelist_addr[i].p_addr; |
bogdanm | 0:eff01767de02 | 1367 | } |
bogdanm | 0:eff01767de02 | 1368 | |
bogdanm | 0:eff01767de02 | 1369 | p_whitelist->addr_count = m_addr_count; |
bogdanm | 0:eff01767de02 | 1370 | p_whitelist->pp_addrs = (m_addr_count != 0) ? s_addr : NULL; |
bogdanm | 0:eff01767de02 | 1371 | p_whitelist->irk_count = m_irk_count; |
bogdanm | 0:eff01767de02 | 1372 | p_whitelist->pp_irks = (m_irk_count != 0) ? s_irk : NULL; |
bogdanm | 0:eff01767de02 | 1373 | |
bogdanm | 0:eff01767de02 | 1374 | return NRF_SUCCESS; |
bogdanm | 0:eff01767de02 | 1375 | } |
bogdanm | 0:eff01767de02 | 1376 | |
bogdanm | 0:eff01767de02 | 1377 | |
bogdanm | 0:eff01767de02 | 1378 | static void bm_pstorage_cb_handler(pstorage_handle_t * handle, |
bogdanm | 0:eff01767de02 | 1379 | uint8_t op_code, |
bogdanm | 0:eff01767de02 | 1380 | uint32_t result, |
bogdanm | 0:eff01767de02 | 1381 | uint8_t * p_data, |
bogdanm | 0:eff01767de02 | 1382 | uint32_t data_len) |
bogdanm | 0:eff01767de02 | 1383 | { |
bogdanm | 0:eff01767de02 | 1384 | if (result != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1385 | { |
bogdanm | 0:eff01767de02 | 1386 | m_bondmngr_config.error_handler(result); |
bogdanm | 0:eff01767de02 | 1387 | } |
bogdanm | 0:eff01767de02 | 1388 | } |
bogdanm | 0:eff01767de02 | 1389 | |
bogdanm | 0:eff01767de02 | 1390 | |
bogdanm | 0:eff01767de02 | 1391 | uint32_t ble_bondmngr_init(ble_bondmngr_init_t * p_init) |
bogdanm | 0:eff01767de02 | 1392 | { |
bogdanm | 0:eff01767de02 | 1393 | pstorage_module_param_t param; |
bogdanm | 0:eff01767de02 | 1394 | uint32_t err_code; |
bogdanm | 0:eff01767de02 | 1395 | |
bogdanm | 0:eff01767de02 | 1396 | if (p_init->error_handler == NULL) |
bogdanm | 0:eff01767de02 | 1397 | { |
bogdanm | 0:eff01767de02 | 1398 | return NRF_ERROR_INVALID_PARAM; |
bogdanm | 0:eff01767de02 | 1399 | } |
bogdanm | 0:eff01767de02 | 1400 | |
bogdanm | 0:eff01767de02 | 1401 | if (BLE_BONDMNGR_MAX_BONDED_CENTRALS > MAX_BONDS_IN_FLASH) |
bogdanm | 0:eff01767de02 | 1402 | { |
bogdanm | 0:eff01767de02 | 1403 | return NRF_ERROR_DATA_SIZE; |
bogdanm | 0:eff01767de02 | 1404 | } |
bogdanm | 0:eff01767de02 | 1405 | |
bogdanm | 0:eff01767de02 | 1406 | param.block_size = sizeof (central_bond_t) + sizeof (uint32_t); |
bogdanm | 0:eff01767de02 | 1407 | param.block_count = MAX_BONDS_IN_FLASH; |
bogdanm | 0:eff01767de02 | 1408 | param.cb = bm_pstorage_cb_handler; |
bogdanm | 0:eff01767de02 | 1409 | |
bogdanm | 0:eff01767de02 | 1410 | // Blocks are requested twice, once for bond information and once for system attributes. |
bogdanm | 0:eff01767de02 | 1411 | // The number of blocks requested has to be the maximum number of bonded devices that |
bogdanm | 0:eff01767de02 | 1412 | // need to be supported. However, the size of blocks can be different if the sizes of |
bogdanm | 0:eff01767de02 | 1413 | // system attributes and bonds are not too close. |
bogdanm | 0:eff01767de02 | 1414 | err_code = pstorage_register(¶m, &mp_flash_bond_info); |
bogdanm | 0:eff01767de02 | 1415 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1416 | { |
bogdanm | 0:eff01767de02 | 1417 | return err_code; |
bogdanm | 0:eff01767de02 | 1418 | } |
bogdanm | 0:eff01767de02 | 1419 | |
bogdanm | 0:eff01767de02 | 1420 | param.block_size = sizeof(central_sys_attr_t) + sizeof(uint32_t); |
bogdanm | 0:eff01767de02 | 1421 | |
bogdanm | 0:eff01767de02 | 1422 | err_code = pstorage_register(¶m, &mp_flash_sys_attr); |
bogdanm | 0:eff01767de02 | 1423 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1424 | { |
bogdanm | 0:eff01767de02 | 1425 | return err_code; |
bogdanm | 0:eff01767de02 | 1426 | } |
bogdanm | 0:eff01767de02 | 1427 | |
bogdanm | 0:eff01767de02 | 1428 | m_bondmngr_config = *p_init; |
bogdanm | 0:eff01767de02 | 1429 | |
bogdanm | 0:eff01767de02 | 1430 | memset(&m_central, 0, sizeof(central_t)); |
bogdanm | 0:eff01767de02 | 1431 | |
bogdanm | 0:eff01767de02 | 1432 | m_central.bond.central_handle = INVALID_CENTRAL_HANDLE; |
bogdanm | 0:eff01767de02 | 1433 | m_conn_handle = BLE_CONN_HANDLE_INVALID; |
bogdanm | 0:eff01767de02 | 1434 | m_centrals_in_db_count = 0; |
bogdanm | 0:eff01767de02 | 1435 | m_bond_info_in_flash_count = 0; |
bogdanm | 0:eff01767de02 | 1436 | m_sys_attr_in_flash_count = 0; |
bogdanm | 0:eff01767de02 | 1437 | |
bogdanm | 0:eff01767de02 | 1438 | SECURITY_STATUS_RESET(); |
bogdanm | 0:eff01767de02 | 1439 | |
bogdanm | 0:eff01767de02 | 1440 | // Erase all stored centrals if specified. |
bogdanm | 0:eff01767de02 | 1441 | if (m_bondmngr_config.bonds_delete) |
bogdanm | 0:eff01767de02 | 1442 | { |
bogdanm | 0:eff01767de02 | 1443 | err_code = flash_pages_erase(); |
bogdanm | 0:eff01767de02 | 1444 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1445 | { |
bogdanm | 0:eff01767de02 | 1446 | return err_code; |
bogdanm | 0:eff01767de02 | 1447 | } |
bogdanm | 0:eff01767de02 | 1448 | |
bogdanm | 0:eff01767de02 | 1449 | m_centrals_in_db_count = 0; |
bogdanm | 0:eff01767de02 | 1450 | int i; |
bogdanm | 0:eff01767de02 | 1451 | for (i = m_centrals_in_db_count; i < BLE_BONDMNGR_MAX_BONDED_CENTRALS; i++) |
bogdanm | 0:eff01767de02 | 1452 | { |
bogdanm | 0:eff01767de02 | 1453 | m_centrals_db[i].bond.central_handle = INVALID_CENTRAL_HANDLE; |
bogdanm | 0:eff01767de02 | 1454 | m_centrals_db[i].sys_attr.sys_attr_size = 0; |
bogdanm | 0:eff01767de02 | 1455 | m_centrals_db[i].sys_attr.central_handle = INVALID_CENTRAL_HANDLE; |
bogdanm | 0:eff01767de02 | 1456 | } |
bogdanm | 0:eff01767de02 | 1457 | } |
bogdanm | 0:eff01767de02 | 1458 | else |
bogdanm | 0:eff01767de02 | 1459 | { |
bogdanm | 0:eff01767de02 | 1460 | // Load bond manager data from flash. |
bogdanm | 0:eff01767de02 | 1461 | err_code = load_all_from_flash(); |
bogdanm | 0:eff01767de02 | 1462 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1463 | { |
bogdanm | 0:eff01767de02 | 1464 | return err_code; |
bogdanm | 0:eff01767de02 | 1465 | } |
bogdanm | 0:eff01767de02 | 1466 | } |
bogdanm | 0:eff01767de02 | 1467 | |
bogdanm | 0:eff01767de02 | 1468 | m_is_bondmngr_initialized = true; |
bogdanm | 0:eff01767de02 | 1469 | |
bogdanm | 0:eff01767de02 | 1470 | return NRF_SUCCESS; |
bogdanm | 0:eff01767de02 | 1471 | } |
bogdanm | 0:eff01767de02 | 1472 | |
bogdanm | 0:eff01767de02 | 1473 | |
bogdanm | 0:eff01767de02 | 1474 | uint32_t ble_bondmngr_central_ids_get(uint16_t * p_central_ids, uint16_t * p_length) |
bogdanm | 0:eff01767de02 | 1475 | { |
bogdanm | 0:eff01767de02 | 1476 | VERIFY_MODULE_INITIALIZED(); |
bogdanm | 0:eff01767de02 | 1477 | int i; |
bogdanm | 0:eff01767de02 | 1478 | if (p_length == NULL) |
bogdanm | 0:eff01767de02 | 1479 | { |
bogdanm | 0:eff01767de02 | 1480 | return NRF_ERROR_NULL; |
bogdanm | 0:eff01767de02 | 1481 | } |
bogdanm | 0:eff01767de02 | 1482 | |
bogdanm | 0:eff01767de02 | 1483 | if (*p_length < m_centrals_in_db_count) |
bogdanm | 0:eff01767de02 | 1484 | { |
bogdanm | 0:eff01767de02 | 1485 | // Length of the input array is not enough to fit all known central identifiers. |
bogdanm | 0:eff01767de02 | 1486 | return NRF_ERROR_DATA_SIZE; |
bogdanm | 0:eff01767de02 | 1487 | } |
bogdanm | 0:eff01767de02 | 1488 | |
bogdanm | 0:eff01767de02 | 1489 | *p_length = m_centrals_in_db_count; |
bogdanm | 0:eff01767de02 | 1490 | if (p_central_ids == NULL) |
bogdanm | 0:eff01767de02 | 1491 | { |
bogdanm | 0:eff01767de02 | 1492 | // Only the length field was required to be filled. |
bogdanm | 0:eff01767de02 | 1493 | return NRF_SUCCESS; |
bogdanm | 0:eff01767de02 | 1494 | } |
bogdanm | 0:eff01767de02 | 1495 | |
bogdanm | 0:eff01767de02 | 1496 | for (i = 0; i < m_centrals_in_db_count; i++) |
bogdanm | 0:eff01767de02 | 1497 | { |
bogdanm | 0:eff01767de02 | 1498 | p_central_ids[i] = m_centrals_db[i].bond.central_id_info.div; |
bogdanm | 0:eff01767de02 | 1499 | } |
bogdanm | 0:eff01767de02 | 1500 | |
bogdanm | 0:eff01767de02 | 1501 | return NRF_SUCCESS; |
bogdanm | 0:eff01767de02 | 1502 | } |
bogdanm | 0:eff01767de02 | 1503 | |
bogdanm | 0:eff01767de02 | 1504 | |
bogdanm | 0:eff01767de02 | 1505 | uint32_t ble_bondmngr_bonded_central_delete(uint16_t central_id) |
bogdanm | 0:eff01767de02 | 1506 | { |
bogdanm | 0:eff01767de02 | 1507 | VERIFY_MODULE_INITIALIZED(); |
bogdanm | 0:eff01767de02 | 1508 | |
bogdanm | 0:eff01767de02 | 1509 | int8_t central_handle_to_be_deleted = INVALID_CENTRAL_HANDLE; |
bogdanm | 0:eff01767de02 | 1510 | uint8_t i; |
bogdanm | 0:eff01767de02 | 1511 | |
bogdanm | 0:eff01767de02 | 1512 | // Search for the handle of the central. |
bogdanm | 0:eff01767de02 | 1513 | for (i = 0; i < m_centrals_in_db_count; i++) |
bogdanm | 0:eff01767de02 | 1514 | { |
bogdanm | 0:eff01767de02 | 1515 | if (m_centrals_db[i].bond.central_id_info.div == central_id) |
bogdanm | 0:eff01767de02 | 1516 | { |
bogdanm | 0:eff01767de02 | 1517 | central_handle_to_be_deleted = i; |
bogdanm | 0:eff01767de02 | 1518 | break; |
bogdanm | 0:eff01767de02 | 1519 | } |
bogdanm | 0:eff01767de02 | 1520 | } |
bogdanm | 0:eff01767de02 | 1521 | |
bogdanm | 0:eff01767de02 | 1522 | if (central_handle_to_be_deleted == INVALID_CENTRAL_HANDLE) |
bogdanm | 0:eff01767de02 | 1523 | { |
bogdanm | 0:eff01767de02 | 1524 | // Central ID not found. |
bogdanm | 0:eff01767de02 | 1525 | return NRF_ERROR_NOT_FOUND; |
bogdanm | 0:eff01767de02 | 1526 | } |
bogdanm | 0:eff01767de02 | 1527 | |
bogdanm | 0:eff01767de02 | 1528 | // Delete the central in RAM. |
bogdanm | 0:eff01767de02 | 1529 | for (i = central_handle_to_be_deleted; i < (m_centrals_in_db_count - 1); i++) |
bogdanm | 0:eff01767de02 | 1530 | { |
bogdanm | 0:eff01767de02 | 1531 | // Overwrite the current central entry with the next one. |
bogdanm | 0:eff01767de02 | 1532 | m_centrals_db[i] = m_centrals_db[i + 1]; |
bogdanm | 0:eff01767de02 | 1533 | |
bogdanm | 0:eff01767de02 | 1534 | // Decrement the value of handle. |
bogdanm | 0:eff01767de02 | 1535 | m_centrals_db[i].bond.central_handle--; |
bogdanm | 0:eff01767de02 | 1536 | if (INVALID_CENTRAL_HANDLE != m_centrals_db[i].sys_attr.central_handle) |
bogdanm | 0:eff01767de02 | 1537 | { |
bogdanm | 0:eff01767de02 | 1538 | m_centrals_db[i].sys_attr.central_handle--; |
bogdanm | 0:eff01767de02 | 1539 | } |
bogdanm | 0:eff01767de02 | 1540 | } |
bogdanm | 0:eff01767de02 | 1541 | |
bogdanm | 0:eff01767de02 | 1542 | // Clear the last database entry. |
bogdanm | 0:eff01767de02 | 1543 | memset(&(m_centrals_db[m_centrals_in_db_count - 1]), 0, sizeof(central_t)); |
bogdanm | 0:eff01767de02 | 1544 | |
bogdanm | 0:eff01767de02 | 1545 | m_centrals_in_db_count--; |
bogdanm | 0:eff01767de02 | 1546 | |
bogdanm | 0:eff01767de02 | 1547 | uint32_t err_code; |
bogdanm | 0:eff01767de02 | 1548 | |
bogdanm | 0:eff01767de02 | 1549 | // Reinitialize the pointers to the memory where bonding info and System Attributes are stored |
bogdanm | 0:eff01767de02 | 1550 | // in flash. |
bogdanm | 0:eff01767de02 | 1551 | // Refresh the data in the flash memory (both Bonding Information and System Attributes). |
bogdanm | 0:eff01767de02 | 1552 | // Erase and rewrite bonding info and System Attributes. |
bogdanm | 0:eff01767de02 | 1553 | |
bogdanm | 0:eff01767de02 | 1554 | err_code = flash_pages_erase(); |
bogdanm | 0:eff01767de02 | 1555 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1556 | { |
bogdanm | 0:eff01767de02 | 1557 | return err_code; |
bogdanm | 0:eff01767de02 | 1558 | } |
bogdanm | 0:eff01767de02 | 1559 | |
bogdanm | 0:eff01767de02 | 1560 | m_bond_info_in_flash_count = 0; |
bogdanm | 0:eff01767de02 | 1561 | m_sys_attr_in_flash_count = 0; |
bogdanm | 0:eff01767de02 | 1562 | |
bogdanm | 0:eff01767de02 | 1563 | for (i = 0; i < m_centrals_in_db_count; i++) |
bogdanm | 0:eff01767de02 | 1564 | { |
bogdanm | 0:eff01767de02 | 1565 | err_code = bond_info_store(&(m_centrals_db[i].bond)); |
bogdanm | 0:eff01767de02 | 1566 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1567 | { |
bogdanm | 0:eff01767de02 | 1568 | return err_code; |
bogdanm | 0:eff01767de02 | 1569 | } |
bogdanm | 0:eff01767de02 | 1570 | } |
bogdanm | 0:eff01767de02 | 1571 | |
bogdanm | 0:eff01767de02 | 1572 | for (i = 0; i < m_centrals_in_db_count; i++) |
bogdanm | 0:eff01767de02 | 1573 | { |
bogdanm | 0:eff01767de02 | 1574 | err_code = sys_attr_store(&(m_centrals_db[i].sys_attr)); |
bogdanm | 0:eff01767de02 | 1575 | if (err_code != NRF_SUCCESS) |
bogdanm | 0:eff01767de02 | 1576 | { |
bogdanm | 0:eff01767de02 | 1577 | return err_code; |
bogdanm | 0:eff01767de02 | 1578 | } |
bogdanm | 0:eff01767de02 | 1579 | } |
bogdanm | 0:eff01767de02 | 1580 | |
bogdanm | 0:eff01767de02 | 1581 | update_whitelist(); |
bogdanm | 0:eff01767de02 | 1582 | |
bogdanm | 0:eff01767de02 | 1583 | return NRF_SUCCESS; |
bogdanm | 0:eff01767de02 | 1584 | } |
bogdanm | 0:eff01767de02 | 1585 | |
bogdanm | 0:eff01767de02 | 1586 | |
bogdanm | 0:eff01767de02 | 1587 | uint32_t ble_bondmngr_is_link_encrypted (bool * status) |
bogdanm | 0:eff01767de02 | 1588 | { |
bogdanm | 0:eff01767de02 | 1589 | VERIFY_MODULE_INITIALIZED(); |
bogdanm | 0:eff01767de02 | 1590 | |
bogdanm | 0:eff01767de02 | 1591 | (*status) = ENCRYPTION_STATUS_GET(); |
bogdanm | 0:eff01767de02 | 1592 | |
bogdanm | 0:eff01767de02 | 1593 | return NRF_SUCCESS; |
bogdanm | 0:eff01767de02 | 1594 | } |