123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415 |
- #include "sdk_common.h"
- #if NRF_MODULE_ENABLED(NRF_SDH)
- #include "nrf_sdh.h"
- #include <stdint.h>
- #include "nrf_sdm.h"
- #include "nrf_nvic.h"
- #include "sdk_config.h"
- #include "app_error.h"
- #include "app_util_platform.h"
- #define NRF_LOG_MODULE_NAME nrf_sdh
- #if NRF_SDH_LOG_ENABLED
- #define NRF_LOG_LEVEL NRF_SDH_LOG_LEVEL
- #define NRF_LOG_INFO_COLOR NRF_SDH_INFO_COLOR
- #define NRF_LOG_DEBUG_COLOR NRF_SDH_DEBUG_COLOR
- #else
- #define NRF_LOG_LEVEL 0
- #endif
- #include "nrf_log.h"
- NRF_LOG_MODULE_REGISTER();
- #if (NRF_SDH_DISPATCH_MODEL == NRF_SDH_DISPATCH_MODEL_APPSH)
- #if (!APP_SCHEDULER_ENABLED)
- #error app_scheduler is required when NRF_SDH_DISPATCH_MODEL is set to NRF_SDH_DISPATCH_MODEL_APPSH
- #endif
- #include "app_scheduler.h"
- #endif
- #if ( (NRF_SDH_CLOCK_LF_SRC == NRF_CLOCK_LF_SRC_RC) \
- && (NRF_SDH_CLOCK_LF_ACCURACY != NRF_CLOCK_LF_ACCURACY_500_PPM))
- #warning Please select NRF_CLOCK_LF_ACCURACY_500_PPM when using NRF_CLOCK_LF_SRC_RC
- #endif
- NRF_SECTION_SET_DEF(sdh_req_observers, nrf_sdh_req_observer_t, NRF_SDH_REQ_OBSERVER_PRIO_LEVELS);
- NRF_SECTION_SET_DEF(sdh_state_observers, nrf_sdh_state_observer_t, NRF_SDH_STATE_OBSERVER_PRIO_LEVELS);
- NRF_SECTION_SET_DEF(sdh_stack_observers, nrf_sdh_stack_observer_t, NRF_SDH_STACK_OBSERVER_PRIO_LEVELS);
- static bool m_nrf_sdh_enabled;
- static bool m_nrf_sdh_suspended;
- static bool m_nrf_sdh_continue;
- static ret_code_t sdh_request_observer_notify(nrf_sdh_req_evt_t req)
- {
- nrf_section_iter_t iter;
- NRF_LOG_DEBUG("State request: 0x%08X", req);
- for (nrf_section_iter_init(&iter, &sdh_req_observers);
- nrf_section_iter_get(&iter) != NULL;
- nrf_section_iter_next(&iter))
- {
- nrf_sdh_req_observer_t * p_observer;
- nrf_sdh_req_evt_handler_t handler;
- p_observer = (nrf_sdh_req_observer_t *) nrf_section_iter_get(&iter);
- handler = p_observer->handler;
- if (handler(req, p_observer->p_context))
- {
- NRF_LOG_DEBUG("Notify observer 0x%08X => ready", p_observer);
- }
- else
- {
-
- NRF_LOG_DEBUG("Notify observer 0x%08X => blocking", p_observer);
- return NRF_ERROR_BUSY;
- }
- }
- return NRF_SUCCESS;
- }
- static void sdh_state_observer_notify(nrf_sdh_state_evt_t evt)
- {
- nrf_section_iter_t iter;
- NRF_LOG_DEBUG("State change: 0x%08X", evt);
- for (nrf_section_iter_init(&iter, &sdh_state_observers);
- nrf_section_iter_get(&iter) != NULL;
- nrf_section_iter_next(&iter))
- {
- nrf_sdh_state_observer_t * p_observer;
- nrf_sdh_state_evt_handler_t handler;
- p_observer = (nrf_sdh_state_observer_t *) nrf_section_iter_get(&iter);
- handler = p_observer->handler;
- handler(evt, p_observer->p_context);
- }
- }
- static void softdevices_evt_irq_enable(void)
- {
- #ifdef SOFTDEVICE_PRESENT
- ret_code_t ret_code = sd_nvic_EnableIRQ((IRQn_Type)SD_EVT_IRQn);
- APP_ERROR_CHECK(ret_code);
- #else
-
- NVIC_EnableIRQ(SD_EVT_IRQn);
- #endif
- }
- static void softdevice_evt_irq_disable(void)
- {
- #ifdef SOFTDEVICE_PRESENT
- ret_code_t ret_code = sd_nvic_DisableIRQ((IRQn_Type)SD_EVT_IRQn);
- APP_ERROR_CHECK(ret_code);
- #else
-
- NVIC_DisableIRQ(SD_EVT_IRQn);
- #endif
- }
- ret_code_t nrf_sdh_enable_request(void)
- {
- ret_code_t ret_code;
- if (m_nrf_sdh_enabled)
- {
- NRF_LOG_RAW_INFO("nrf_sdh_enable_request -- NRF_ERROR_INVALID_STATE\n");
- return NRF_ERROR_INVALID_STATE;
- }
- m_nrf_sdh_continue = true;
-
- if (sdh_request_observer_notify(NRF_SDH_EVT_ENABLE_REQUEST) == NRF_ERROR_BUSY)
- {
-
- NRF_LOG_RAW_INFO("nrf_sdh_enable_request -- NRF_SUCCESS\n");
- return NRF_SUCCESS;
- }
-
- sdh_state_observer_notify(NRF_SDH_EVT_STATE_ENABLE_PREPARE);
- NRF_LOG_RAW_INFO("nrf_sdh_enable_request -- sdh_state_observer_notify\n");
- nrf_clock_lf_cfg_t const clock_lf_cfg =
- {
- .source = NRF_SDH_CLOCK_LF_SRC,
- .rc_ctiv = NRF_SDH_CLOCK_LF_RC_CTIV,
- .rc_temp_ctiv = NRF_SDH_CLOCK_LF_RC_TEMP_CTIV,
- .accuracy = NRF_SDH_CLOCK_LF_ACCURACY
- };
- CRITICAL_REGION_ENTER();
- #ifdef ANT_LICENSE_KEY
- ret_code = sd_softdevice_enable(&clock_lf_cfg, app_error_fault_handler, ANT_LICENSE_KEY);
- #else
- ret_code = sd_softdevice_enable(&clock_lf_cfg, app_error_fault_handler);
- #endif
- m_nrf_sdh_enabled = (ret_code == NRF_SUCCESS);
- CRITICAL_REGION_EXIT();
- if (ret_code != NRF_SUCCESS)
- {
- return ret_code;
- }
- m_nrf_sdh_continue = false;
- m_nrf_sdh_suspended = false;
-
-
- softdevices_evt_irq_enable();
-
- sdh_state_observer_notify(NRF_SDH_EVT_STATE_ENABLED);
- return NRF_SUCCESS;
- }
- ret_code_t nrf_sdh_disable_request(void)
- {
- ret_code_t ret_code;
- if (!m_nrf_sdh_enabled)
- {
- NRF_LOG_RAW_INFO("nrf_sdh_disable_request -- NRF_ERROR_INVALID_STATE\n");
- return NRF_ERROR_INVALID_STATE;
- }
- m_nrf_sdh_continue = true;
-
- if (sdh_request_observer_notify(NRF_SDH_EVT_DISABLE_REQUEST) == NRF_ERROR_BUSY)
- {
-
- NRF_LOG_RAW_INFO("nrf_sdh_disable_request -- NRF_SUCCESS\n");
- return NRF_SUCCESS;
- }
-
- sdh_state_observer_notify(NRF_SDH_EVT_STATE_DISABLE_PREPARE);
- CRITICAL_REGION_ENTER();
- ret_code = sd_softdevice_disable();
- m_nrf_sdh_enabled = false;
- CRITICAL_REGION_EXIT();
- if (ret_code != NRF_SUCCESS)
- {
- return ret_code;
- }
- m_nrf_sdh_continue = false;
- softdevice_evt_irq_disable();
-
- sdh_state_observer_notify(NRF_SDH_EVT_STATE_DISABLED);
- return NRF_SUCCESS;
- }
- ret_code_t nrf_sdh_request_continue(void)
- {
- if (!m_nrf_sdh_continue)
- {
- return NRF_ERROR_INVALID_STATE;
- }
- if (m_nrf_sdh_enabled)
- {
- return nrf_sdh_disable_request();
- }
- else
- {
- return nrf_sdh_enable_request();
- }
- }
- bool nrf_sdh_is_enabled(void)
- {
- return m_nrf_sdh_enabled;
- }
- void nrf_sdh_suspend(void)
- {
- if (!m_nrf_sdh_enabled)
- {
- return;
- }
- softdevice_evt_irq_disable();
- m_nrf_sdh_suspended = true;
- }
- void nrf_sdh_resume(void)
- {
- if ((!m_nrf_sdh_suspended) || (!m_nrf_sdh_enabled))
- {
- return;
- }
-
- #ifdef SOFTDEVICE_PRESENT
- ret_code_t ret_code = sd_nvic_SetPendingIRQ((IRQn_Type)SD_EVT_IRQn);
- APP_ERROR_CHECK(ret_code);
- #else
- NVIC_SetPendingIRQ((IRQn_Type)SD_EVT_IRQn);
- #endif
- softdevices_evt_irq_enable();
- m_nrf_sdh_suspended = false;
- }
- bool nrf_sdh_is_suspended(void)
- {
- return (!m_nrf_sdh_enabled) || (m_nrf_sdh_suspended);
- }
- void nrf_sdh_evts_poll(void)
- {
- nrf_section_iter_t iter;
-
- for (nrf_section_iter_init(&iter, &sdh_stack_observers);
- nrf_section_iter_get(&iter) != NULL;
- nrf_section_iter_next(&iter))
- {
- nrf_sdh_stack_observer_t * p_observer;
- nrf_sdh_stack_evt_handler_t handler;
- p_observer = (nrf_sdh_stack_observer_t *) nrf_section_iter_get(&iter);
- handler = p_observer->handler;
- handler(p_observer->p_context);
- }
- }
- #if (NRF_SDH_DISPATCH_MODEL == NRF_SDH_DISPATCH_MODEL_INTERRUPT)
- void SD_EVT_IRQHandler(void)
- {
- nrf_sdh_evts_poll();
- }
- #elif (NRF_SDH_DISPATCH_MODEL == NRF_SDH_DISPATCH_MODEL_APPSH)
- static void appsh_events_poll(void * p_event_data, uint16_t event_size)
- {
- UNUSED_PARAMETER(p_event_data);
- UNUSED_PARAMETER(event_size);
- nrf_sdh_evts_poll();
- }
- void SD_EVT_IRQHandler(void)
- {
- ret_code_t ret_code = app_sched_event_put(NULL, 0, appsh_events_poll);
- APP_ERROR_CHECK(ret_code);
- }
- #elif (NRF_SDH_DISPATCH_MODEL == NRF_SDH_DISPATCH_MODEL_POLLING)
- #else
- #error "Unknown SoftDevice handler dispatch model."
- #endif
- #endif
|