123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840 |
- /**
- * Copyright (c) 2015 - 2020, Nordic Semiconductor ASA
- *
- * All rights reserved.
- *
- * Redistribution and use in source and binary forms, with or without modification,
- * are permitted provided that the following conditions are met:
- *
- * 1. Redistributions of source code must retain the above copyright notice, this
- * list of conditions and the following disclaimer.
- *
- * 2. Redistributions in binary form, except as embedded into a Nordic
- * Semiconductor ASA integrated circuit in a product or a software update for
- * such product, must reproduce the above copyright notice, this list of
- * conditions and the following disclaimer in the documentation and/or other
- * materials provided with the distribution.
- *
- * 3. Neither the name of Nordic Semiconductor ASA nor the names of its
- * contributors may be used to endorse or promote products derived from this
- * software without specific prior written permission.
- *
- * 4. This software, with or without modification, must only be used with a
- * Nordic Semiconductor ASA integrated circuit.
- *
- * 5. Any software provided in binary form under this license must not be reverse
- * engineered, decompiled, modified and/or disassembled.
- *
- * THIS SOFTWARE IS PROVIDED BY NORDIC SEMICONDUCTOR ASA "AS IS" AND ANY EXPRESS
- * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
- * OF MERCHANTABILITY, NONINFRINGEMENT, AND FITNESS FOR A PARTICULAR PURPOSE ARE
- * DISCLAIMED. IN NO EVENT SHALL NORDIC SEMICONDUCTOR ASA OR CONTRIBUTORS BE
- * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
- * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE
- * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
- * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
- * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
- * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- *
- */
- #include "sdk_common.h"
- #if NRF_MODULE_ENABLED(PEER_MANAGER)
- #include "gatt_cache_manager.h"
- #include "ble_gap.h"
- #include "ble_err.h"
- #include "ble_conn_state.h"
- #include "peer_manager_types.h"
- #include "peer_manager_internal.h"
- #include "id_manager.h"
- #include "gatts_cache_manager.h"
- #include "peer_data_storage.h"
- #include "peer_database.h"
- #include "nrf_mtx.h"
- #define NRF_LOG_MODULE_NAME peer_manager_gcm
- #if PM_LOG_ENABLED
- #define NRF_LOG_LEVEL PM_LOG_LEVEL
- #define NRF_LOG_INFO_COLOR PM_LOG_INFO_COLOR
- #define NRF_LOG_DEBUG_COLOR PM_LOG_DEBUG_COLOR
- #else
- #define NRF_LOG_LEVEL 0
- #endif // PM_LOG_ENABLED
- #include "nrf_log.h"
- #include "nrf_log_ctrl.h"
- NRF_LOG_MODULE_REGISTER();
- #include "nrf_strerror.h"
- // The number of registered event handlers.
- #define GCM_EVENT_HANDLERS_CNT (sizeof(m_evt_handlers) / sizeof(m_evt_handlers[0]))
- // GATT Cache Manager event handler in Peer Manager.
- extern void pm_gcm_evt_handler(pm_evt_t * p_gcm_evt);
- // GATT Cache Manager events' handlers.
- // The number of elements in this array is GCM_EVENT_HANDLERS_CNT.
- static pm_evt_handler_internal_t m_evt_handlers[] =
- {
- pm_gcm_evt_handler
- };
- static bool m_module_initialized;
- static nrf_mtx_t m_db_update_in_progress_mutex; /**< Mutex indicating whether a local DB write operation is ongoing. */
- static ble_conn_state_user_flag_id_t m_flag_local_db_update_pending; /**< Flag ID for flag collection to keep track of which connections need a local DB update procedure. */
- static ble_conn_state_user_flag_id_t m_flag_local_db_apply_pending; /**< Flag ID for flag collection to keep track of which connections need a local DB apply procedure. */
- static ble_conn_state_user_flag_id_t m_flag_service_changed_pending; /**< Flag ID for flag collection to keep track of which connections need to be sent a service changed indication. */
- static ble_conn_state_user_flag_id_t m_flag_service_changed_sent; /**< Flag ID for flag collection to keep track of which connections have been sent a service changed indication and are waiting for a handle value confirmation. */
- static ble_conn_state_user_flag_id_t m_flag_car_update_pending; /**< Flag ID for flag collection to keep track of which connections need to have their Central Address Resolution value stored. */
- static ble_conn_state_user_flag_id_t m_flag_car_handle_queried; /**< Flag ID for flag collection to keep track of which connections are pending Central Address Resolution handle reply. */
- static ble_conn_state_user_flag_id_t m_flag_car_value_queried; /**< Flag ID for flag collection to keep track of which connections are pending Central Address Resolution value reply. */
- #ifdef PM_SERVICE_CHANGED_ENABLED
- STATIC_ASSERT(PM_SERVICE_CHANGED_ENABLED || !NRF_SDH_BLE_SERVICE_CHANGED,
- "PM_SERVICE_CHANGED_ENABLED should be enabled if NRF_SDH_BLE_SERVICE_CHANGED is enabled.");
- #else
- #define PM_SERVICE_CHANGED_ENABLED 1
- #endif
- /**@brief Function for resetting the module variable(s) of the GSCM module.
- *
- * @param[out] The instance to reset.
- */
- static void internal_state_reset()
- {
- m_module_initialized = false;
- }
- static void evt_send(pm_evt_t * p_gcm_evt)
- {
- p_gcm_evt->peer_id = im_peer_id_get_by_conn_handle(p_gcm_evt->conn_handle);
- for (uint32_t i = 0; i < GCM_EVENT_HANDLERS_CNT; i++)
- {
- m_evt_handlers[i](p_gcm_evt);
- }
- }
- /**@brief Function for checking a write event for whether a CCCD was written during the write
- * operation.
- *
- * @param[in] p_write_evt The parameters of the write event.
- *
- * @return Whether the write was on a CCCD.
- */
- static bool cccd_written(ble_gatts_evt_write_t const * p_write_evt)
- {
- return ( (p_write_evt->op == BLE_GATTS_OP_WRITE_REQ)
- && (p_write_evt->uuid.type == BLE_UUID_TYPE_BLE)
- && (p_write_evt->uuid.uuid == BLE_UUID_DESCRIPTOR_CLIENT_CHAR_CONFIG)
- );
- }
- /**@brief Function for sending an PM_EVT_ERROR_UNEXPECTED event.
- *
- * @param[in] conn_handle The connection handle the event pertains to.
- * @param[in] err_code The unexpected error that occurred.
- */
- static void send_unexpected_error(uint16_t conn_handle, ret_code_t err_code)
- {
- pm_evt_t error_evt =
- {
- .evt_id = PM_EVT_ERROR_UNEXPECTED,
- .conn_handle = conn_handle,
- .params =
- {
- .error_unexpected =
- {
- .error = err_code
- }
- }
- };
- evt_send(&error_evt);
- }
- /**@brief Function for performing the local DB update procedure in an event context, where no return
- * code can be given.
- *
- * @details This function will do the procedure, and check the result, set a flag if needed, and
- * send an event if needed.
- *
- * @param[in] conn_handle The connection to perform the procedure on.
- */
- static void local_db_apply_in_evt(uint16_t conn_handle)
- {
- bool set_procedure_as_pending = false;
- ret_code_t err_code;
- pm_evt_t event =
- {
- .conn_handle = conn_handle,
- };
- if (conn_handle == BLE_CONN_HANDLE_INVALID)
- {
- return;
- }
- err_code = gscm_local_db_cache_apply(conn_handle);
- switch (err_code)
- {
- case NRF_SUCCESS:
- event.evt_id = PM_EVT_LOCAL_DB_CACHE_APPLIED;
- evt_send(&event);
- break;
- case NRF_ERROR_BUSY:
- set_procedure_as_pending = true;
- break;
- case NRF_ERROR_INVALID_DATA:
- event.evt_id = PM_EVT_LOCAL_DB_CACHE_APPLY_FAILED;
- NRF_LOG_WARNING("The local database has changed, so some subscriptions to notifications "\
- "and indications could not be restored for conn_handle %d",
- conn_handle);
- evt_send(&event);
- break;
- case BLE_ERROR_INVALID_CONN_HANDLE:
- /* Do nothing */
- break;
- default:
- NRF_LOG_ERROR("gscm_local_db_cache_apply() returned %s which should not happen. "\
- "conn_handle: %d",
- nrf_strerror_get(err_code),
- conn_handle);
- send_unexpected_error(conn_handle, err_code);
- break;
- }
- ble_conn_state_user_flag_set(conn_handle, m_flag_local_db_apply_pending, set_procedure_as_pending);
- }
- /**@brief Function for asynchronously starting a DB update procedure.
- *
- * @note This procedure can only be started asynchronously.
- *
- * @param[in] conn_handle The connection to perform the procedure on.
- * @param[in] update Whether to perform the procedure.
- */
- static __INLINE void local_db_update(uint16_t conn_handle, bool update)
- {
- ble_conn_state_user_flag_set(conn_handle, m_flag_local_db_update_pending, update);
- }
- /**@brief Function for performing the local DB update procedure in an event context, where no return
- * code can be given.
- *
- * @details This function will do the procedure, and check the result, set a flag if needed, and
- * send an event if needed.
- *
- * @param[in] conn_handle The connection to perform the procedure on.
- */
- static bool local_db_update_in_evt(uint16_t conn_handle)
- {
- bool set_procedure_as_pending = false;
- bool success = false;
- ret_code_t err_code = gscm_local_db_cache_update(conn_handle);
- switch (err_code)
- {
- case NRF_SUCCESS:
- success = true;
- break;
- case BLE_ERROR_INVALID_CONN_HANDLE:
- /* Do nothing */
- break;
- case NRF_ERROR_BUSY:
- set_procedure_as_pending = true;
- break;
- case NRF_ERROR_STORAGE_FULL:
- {
- pm_evt_t event =
- {
- .evt_id = PM_EVT_STORAGE_FULL,
- .conn_handle = conn_handle,
- };
- NRF_LOG_WARNING("Flash full. Could not store data for conn_handle: %d", conn_handle);
- evt_send(&event);
- break;
- }
- default:
- NRF_LOG_ERROR("gscm_local_db_cache_update() returned %s for conn_handle: %d",
- nrf_strerror_get(err_code),
- conn_handle);
- send_unexpected_error(conn_handle, err_code);
- break;
- }
- local_db_update(conn_handle, set_procedure_as_pending);
- return success;
- }
- #if PM_SERVICE_CHANGED_ENABLED
- /**@brief Function for getting the value of the CCCD for the service changed characteristic.
- *
- * @details This function will search all system handles consecutively.
- *
- * @param[in] conn_handle The connection to check.
- * @param[out] p_cccd The CCCD value of the service changed characteristic for this link.
- *
- * @return Any error from @ref sd_ble_gatts_value_get or @ref sd_ble_gatts_attr_get.
- */
- static ret_code_t service_changed_cccd(uint16_t conn_handle, uint16_t * p_cccd)
- {
- bool sc_found = false;
- uint16_t end_handle;
- ret_code_t err_code = sd_ble_gatts_initial_user_handle_get(&end_handle);
- ASSERT(err_code == NRF_SUCCESS);
- for (uint16_t handle = 1; handle < end_handle; handle++)
- {
- ble_uuid_t uuid;
- ble_gatts_value_t value = {.p_value = (uint8_t *)&uuid.uuid, .len = 2, .offset = 0};
- err_code = sd_ble_gatts_attr_get(handle, &uuid, NULL);
- if (err_code != NRF_SUCCESS)
- {
- return err_code;
- }
- else if (!sc_found && (uuid.uuid == BLE_UUID_GATT_CHARACTERISTIC_SERVICE_CHANGED))
- {
- sc_found = true;
- }
- else if (sc_found && (uuid.uuid == BLE_UUID_DESCRIPTOR_CLIENT_CHAR_CONFIG))
- {
- value.p_value = (uint8_t *)p_cccd;
- return sd_ble_gatts_value_get(conn_handle, handle, &value);
- }
- }
- return NRF_ERROR_NOT_FOUND;
- }
- /**@brief Function for sending a service changed indication in an event context, where no return
- * code can be given.
- *
- * @details This function will do the procedure, and check the result, set a flag if needed, and
- * send an event if needed.
- *
- * @param[in] conn_handle The connection to perform the procedure on.
- */
- static void service_changed_send_in_evt(uint16_t conn_handle)
- {
- bool sc_pending_state = true;
- bool sc_sent_state = false;
- ret_code_t err_code = gscm_service_changed_ind_send(conn_handle);
- switch (err_code)
- {
- case NRF_SUCCESS:
- {
- pm_evt_t event =
- {
- .evt_id = PM_EVT_SERVICE_CHANGED_IND_SENT,
- .conn_handle = conn_handle,
- };
- sc_sent_state = true;
- evt_send(&event);
- break;
- }
- case NRF_ERROR_BUSY:
- // Do nothing.
- break;
- case NRF_ERROR_INVALID_STATE:
- {
- uint16_t cccd;
- err_code = service_changed_cccd(conn_handle, &cccd);
- if ((err_code == NRF_SUCCESS) && cccd)
- {
- // Possible ATT_MTU exchange ongoing.
- // Do nothing, treat as busy.
- break;
- }
- else
- {
- if (err_code != NRF_SUCCESS)
- {
- NRF_LOG_DEBUG("Unexpected error when looking for service changed CCCD: %s",
- nrf_strerror_get(err_code));
- }
- // CCCDs not enabled or an error happened. Drop indication.
- // Fallthrough.
- }
- }
- // Sometimes fallthrough.
- case NRF_ERROR_NOT_SUPPORTED:
- // Service changed not supported. Drop indication.
- sc_pending_state = false;
- gscm_db_change_notification_done(im_peer_id_get_by_conn_handle(conn_handle));
- break;
- case BLE_ERROR_GATTS_SYS_ATTR_MISSING:
- local_db_apply_in_evt(conn_handle);
- break;
- case BLE_ERROR_INVALID_CONN_HANDLE:
- // Do nothing.
- break;
- default:
- NRF_LOG_ERROR("gscm_service_changed_ind_send() returned %s for conn_handle: %d",
- nrf_strerror_get(err_code),
- conn_handle);
- send_unexpected_error(conn_handle, err_code);
- break;
- }
- ble_conn_state_user_flag_set(conn_handle, m_flag_service_changed_pending, sc_pending_state);
- ble_conn_state_user_flag_set(conn_handle, m_flag_service_changed_sent, sc_sent_state);
- }
- #endif
- static void apply_pending_handle(uint16_t conn_handle, void * p_context)
- {
- UNUSED_PARAMETER(p_context);
- local_db_apply_in_evt(conn_handle);
- }
- static __INLINE void apply_pending_flags_check(void)
- {
- UNUSED_RETURN_VALUE(ble_conn_state_for_each_set_user_flag(m_flag_local_db_apply_pending,
- apply_pending_handle,
- NULL));
- }
- static void db_update_pending_handle(uint16_t conn_handle, void * p_context)
- {
- UNUSED_PARAMETER(p_context);
- if (nrf_mtx_trylock(&m_db_update_in_progress_mutex))
- {
- if (local_db_update_in_evt(conn_handle))
- {
- // Successfully started writing to flash.
- return;
- }
- else
- {
- nrf_mtx_unlock(&m_db_update_in_progress_mutex);
- }
- }
- }
- #if PM_SERVICE_CHANGED_ENABLED
- static void sc_send_pending_handle(uint16_t conn_handle, void * p_context)
- {
- UNUSED_PARAMETER(p_context);
- if (!ble_conn_state_user_flag_get(conn_handle, m_flag_service_changed_sent))
- {
- service_changed_send_in_evt(conn_handle);
- }
- }
- static __INLINE void service_changed_pending_flags_check(void)
- {
- UNUSED_RETURN_VALUE(ble_conn_state_for_each_set_user_flag(m_flag_service_changed_pending,
- sc_send_pending_handle,
- NULL));
- }
- static void service_changed_needed(uint16_t conn_handle)
- {
- if (gscm_service_changed_ind_needed(conn_handle))
- {
- ble_conn_state_user_flag_set(conn_handle, m_flag_service_changed_pending, true);
- }
- }
- #endif
- static void car_update_pending_handle(uint16_t conn_handle, void * p_context)
- {
- UNUSED_PARAMETER(p_context);
- ble_uuid_t car_uuid;
- memset(&car_uuid, 0, sizeof(ble_uuid_t));
- car_uuid.uuid = BLE_UUID_GAP_CHARACTERISTIC_CAR;
- car_uuid.type = BLE_UUID_TYPE_BLE;
- ble_gattc_handle_range_t const car_handle_range = {1, 0xFFFF};
- ret_code_t err_code = sd_ble_gattc_char_value_by_uuid_read(conn_handle, &car_uuid, &car_handle_range);
- if (err_code == NRF_SUCCESS)
- {
- ble_conn_state_user_flag_set(conn_handle, m_flag_car_handle_queried, true);
- }
- }
- static void car_update_needed(uint16_t conn_handle)
- {
- pm_peer_data_t peer_data;
- if (pds_peer_data_read(im_peer_id_get_by_conn_handle(conn_handle),
- PM_PEER_DATA_ID_CENTRAL_ADDR_RES,
- &peer_data,
- NULL) == NRF_ERROR_NOT_FOUND)
- {
- ble_conn_state_user_flag_set(conn_handle, m_flag_car_update_pending, true);
- }
- }
- static __INLINE void update_pending_flags_check(void)
- {
- uint32_t count = ble_conn_state_for_each_set_user_flag(m_flag_local_db_update_pending,
- db_update_pending_handle,
- NULL);
- if (count == 0)
- {
- count = ble_conn_state_for_each_set_user_flag(m_flag_car_update_pending,
- car_update_pending_handle,
- NULL);
- UNUSED_RETURN_VALUE(count);
- }
- }
- /**@brief Callback function for events from the ID Manager module.
- * This function is registered in the ID Manager module.
- *
- * @param[in] p_event The event from the ID Manager module.
- */
- void gcm_im_evt_handler(pm_evt_t * p_event)
- {
- switch (p_event->evt_id)
- {
- case PM_EVT_BONDED_PEER_CONNECTED:
- local_db_apply_in_evt(p_event->conn_handle);
- #if (PM_SERVICE_CHANGED_ENABLED == 1)
- service_changed_needed(p_event->conn_handle);
- #endif
- car_update_needed(p_event->conn_handle);
- update_pending_flags_check();
- break;
- default:
- break;
- }
- }
- /**@brief Callback function for events from the Peer Database module.
- * This handler is extern in Peer Database.
- *
- * @param[in] p_event The event from the Security Dispatcher module.
- */
- void gcm_pdb_evt_handler(pm_evt_t * p_event)
- {
- if ( p_event->evt_id == PM_EVT_PEER_DATA_UPDATE_SUCCEEDED
- && p_event->params.peer_data_update_succeeded.action == PM_PEER_DATA_OP_UPDATE)
- {
- switch (p_event->params.peer_data_update_succeeded.data_id)
- {
- case PM_PEER_DATA_ID_BONDING:
- {
- uint16_t conn_handle = im_conn_handle_get(p_event->peer_id);
- if (conn_handle != BLE_CONN_HANDLE_INVALID)
- {
- local_db_update(conn_handle, true);
- car_update_needed(conn_handle);
- }
- break;
- }
- #if PM_SERVICE_CHANGED_ENABLED
- case PM_PEER_DATA_ID_SERVICE_CHANGED_PENDING:
- {
- ret_code_t err_code;
- pm_peer_data_flash_t peer_data;
- err_code = pdb_peer_data_ptr_get(p_event->peer_id,
- PM_PEER_DATA_ID_SERVICE_CHANGED_PENDING,
- &peer_data);
- if (err_code == NRF_SUCCESS)
- {
- if (*peer_data.p_service_changed_pending)
- {
- uint16_t conn_handle = im_conn_handle_get(p_event->peer_id);
- if (conn_handle != BLE_CONN_HANDLE_INVALID)
- {
- ble_conn_state_user_flag_set(conn_handle, m_flag_service_changed_pending, true);
- service_changed_pending_flags_check();
- }
- }
- }
- break;
- }
- #endif
- case PM_PEER_DATA_ID_GATT_LOCAL:
- if (m_db_update_in_progress_mutex == NRF_MTX_LOCKED)
- {
- nrf_mtx_unlock(&m_db_update_in_progress_mutex);
- }
- // Expecting a call to update_pending_flags_check() immediately.
- break;
- default:
- /* No action */
- break;
- }
- }
- update_pending_flags_check();
- }
- ret_code_t gcm_init()
- {
- NRF_PM_DEBUG_CHECK(!m_module_initialized);
- internal_state_reset();
- m_flag_local_db_update_pending = ble_conn_state_user_flag_acquire();
- m_flag_local_db_apply_pending = ble_conn_state_user_flag_acquire();
- m_flag_service_changed_pending = ble_conn_state_user_flag_acquire();
- m_flag_service_changed_sent = ble_conn_state_user_flag_acquire();
- m_flag_car_update_pending = ble_conn_state_user_flag_acquire();
- m_flag_car_handle_queried = ble_conn_state_user_flag_acquire();
- m_flag_car_value_queried = ble_conn_state_user_flag_acquire();
- if ((m_flag_local_db_update_pending == BLE_CONN_STATE_USER_FLAG_INVALID)
- || (m_flag_local_db_apply_pending == BLE_CONN_STATE_USER_FLAG_INVALID)
- || (m_flag_service_changed_pending == BLE_CONN_STATE_USER_FLAG_INVALID)
- || (m_flag_service_changed_sent == BLE_CONN_STATE_USER_FLAG_INVALID)
- || (m_flag_car_update_pending == BLE_CONN_STATE_USER_FLAG_INVALID)
- || (m_flag_car_handle_queried == BLE_CONN_STATE_USER_FLAG_INVALID)
- || (m_flag_car_value_queried == BLE_CONN_STATE_USER_FLAG_INVALID)
- )
- {
- NRF_LOG_ERROR("Could not acquire conn_state user flags. Increase "\
- "BLE_CONN_STATE_USER_FLAG_COUNT in the ble_conn_state module.");
- return NRF_ERROR_INTERNAL;
- }
- nrf_mtx_init(&m_db_update_in_progress_mutex);
- m_module_initialized = true;
- return NRF_SUCCESS;
- }
- void store_car_value(uint16_t conn_handle, bool car_value)
- {
- // Use a uint32_t to enforce 4-byte alignment.
- static const uint32_t car_value_true = true;
- static const uint32_t car_value_false = false;
- pm_peer_data_const_t peer_data =
- {
- .data_id = PM_PEER_DATA_ID_CENTRAL_ADDR_RES,
- .length_words = 1,
- };
- ble_conn_state_user_flag_set(conn_handle, m_flag_car_update_pending, false);
- peer_data.p_central_addr_res = car_value ? &car_value_true : &car_value_false;
- ret_code_t err_code = pds_peer_data_store(im_peer_id_get_by_conn_handle(conn_handle), &peer_data, NULL);
- if (err_code != NRF_SUCCESS)
- {
- NRF_LOG_WARNING("CAR char value couldn't be stored (error: %s). Reattempt will happen on the next connection.", nrf_strerror_get(err_code));
- }
- }
- /**@brief Callback function for BLE events from the SoftDevice.
- *
- * @param[in] p_ble_evt The BLE event from the SoftDevice.
- */
- void gcm_ble_evt_handler(ble_evt_t const * p_ble_evt)
- {
- uint16_t conn_handle = p_ble_evt->evt.gatts_evt.conn_handle;
- switch (p_ble_evt->header.evt_id)
- {
- case BLE_GATTS_EVT_SYS_ATTR_MISSING:
- local_db_apply_in_evt(conn_handle);
- break;
- #if PM_SERVICE_CHANGED_ENABLED
- case BLE_GATTS_EVT_SC_CONFIRM:
- {
- pm_evt_t event =
- {
- .evt_id = PM_EVT_SERVICE_CHANGED_IND_CONFIRMED,
- .peer_id = im_peer_id_get_by_conn_handle(conn_handle),
- .conn_handle = conn_handle,
- };
- gscm_db_change_notification_done(event.peer_id);
- ble_conn_state_user_flag_set(conn_handle, m_flag_service_changed_sent, false);
- ble_conn_state_user_flag_set(conn_handle, m_flag_service_changed_pending, false);
- evt_send(&event);
- break;
- }
- #endif
- case BLE_GATTS_EVT_WRITE:
- if (cccd_written(&p_ble_evt->evt.gatts_evt.params.write))
- {
- local_db_update(conn_handle, true);
- update_pending_flags_check();
- }
- break;
- case BLE_GATTC_EVT_CHAR_VAL_BY_UUID_READ_RSP:
- {
- bool handle_found = false;
- conn_handle = p_ble_evt->evt.gattc_evt.conn_handle;
- const ble_gattc_evt_char_val_by_uuid_read_rsp_t * p_val = &p_ble_evt->evt.gattc_evt.params.char_val_by_uuid_read_rsp;
- if (!ble_conn_state_user_flag_get(conn_handle, m_flag_car_handle_queried))
- {
- break;
- }
- ble_conn_state_user_flag_set(conn_handle, m_flag_car_handle_queried, false);
- if (p_ble_evt->evt.gattc_evt.gatt_status == BLE_GATT_STATUS_ATTERR_ATTRIBUTE_NOT_FOUND)
- {
- // Store 0.
- }
- else if (p_ble_evt->evt.gattc_evt.gatt_status != BLE_GATT_STATUS_SUCCESS)
- {
- NRF_LOG_WARNING("Unexpected GATT status while getting CAR char value: 0x%x",
- p_ble_evt->evt.gattc_evt.gatt_status);
- // Store 0.
- }
- else
- {
- if (p_val->count != 1)
- {
- NRF_LOG_WARNING("Multiple (%d) CAR characteristics found, using the first.",
- p_val->count);
- }
- if (p_val->value_len != 1)
- {
- NRF_LOG_WARNING("Unexpected CAR characteristic value length (%d), store 0.",
- p_val->value_len);
- // Store 0.
- }
- else
- {
- ret_code_t err_code = sd_ble_gattc_read(conn_handle, *(uint16_t*)p_val->handle_value, 0);
- if (err_code == NRF_SUCCESS)
- {
- handle_found = true;
- ble_conn_state_user_flag_set(conn_handle, m_flag_car_value_queried, true);
- }
- }
- }
- if (!handle_found)
- {
- store_car_value(conn_handle, false);
- }
- break;
- }
- case BLE_GATTC_EVT_READ_RSP:
- {
- bool car_value = false;
- conn_handle = p_ble_evt->evt.gattc_evt.conn_handle;
- const ble_gattc_evt_read_rsp_t * p_val = &p_ble_evt->evt.gattc_evt.params.read_rsp;
- if (!ble_conn_state_user_flag_get(conn_handle, m_flag_car_value_queried))
- {
- break;
- }
- ble_conn_state_user_flag_set(conn_handle, m_flag_car_value_queried, false);
- if (p_ble_evt->evt.gattc_evt.gatt_status != BLE_GATT_STATUS_SUCCESS)
- {
- NRF_LOG_WARNING("Unexpected GATT status while getting CAR char value: 0x%x",
- p_ble_evt->evt.gattc_evt.gatt_status);
- // Store 0.
- }
- else
- {
- if (p_val->len != 1)
- {
- NRF_LOG_WARNING("Unexpected CAR characteristic value length (%d), store 0.",
- p_val->len);
- // Store 0.
- }
- else
- {
- car_value = *p_val->data;
- }
- }
- store_car_value(conn_handle, car_value);
- }
- }
- apply_pending_flags_check();
- #if PM_SERVICE_CHANGED_ENABLED
- service_changed_pending_flags_check();
- #endif
- }
- ret_code_t gcm_local_db_cache_update(uint16_t conn_handle)
- {
- NRF_PM_DEBUG_CHECK(m_module_initialized);
- local_db_update(conn_handle, true);
- update_pending_flags_check();
- return NRF_SUCCESS;
- }
- #if PM_SERVICE_CHANGED_ENABLED
- void gcm_local_database_has_changed(void)
- {
- gscm_local_database_has_changed();
- ble_conn_state_conn_handle_list_t conn_handles = ble_conn_state_conn_handles();
- for (uint16_t i = 0; i < conn_handles.len; i++)
- {
- if (im_peer_id_get_by_conn_handle(conn_handles.conn_handles[i]) == PM_PEER_ID_INVALID)
- {
- ble_conn_state_user_flag_set(conn_handles.conn_handles[i], m_flag_service_changed_pending, true);
- }
- }
- service_changed_pending_flags_check();
- }
- #endif
- #endif // NRF_MODULE_ENABLED(PEER_MANAGER)
|