123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127 |
- #include "app_util_platform.h"
- #ifdef SOFTDEVICE_PRESENT
- nrf_nvic_state_t nrf_nvic_state;
- #endif
- static uint32_t m_in_critical_region = 0;
- void app_util_disable_irq(void)
- {
- __disable_irq();
- m_in_critical_region++;
- }
- void app_util_enable_irq(void)
- {
- m_in_critical_region--;
- if (m_in_critical_region == 0)
- {
- __enable_irq();
- }
- }
- void app_util_critical_region_enter(uint8_t *p_nested)
- {
- #if __CORTEX_M == (0x04U)
- ASSERT(APP_LEVEL_PRIVILEGED == privilege_level_get())
- #endif
- #if defined(SOFTDEVICE_PRESENT)
-
- (void) sd_nvic_critical_region_enter(p_nested);
- #else
- app_util_disable_irq();
- #endif
- }
- void app_util_critical_region_exit(uint8_t nested)
- {
- #if __CORTEX_M == (0x04U)
- ASSERT(APP_LEVEL_PRIVILEGED == privilege_level_get())
- #endif
- #if defined(SOFTDEVICE_PRESENT)
-
- (void) sd_nvic_critical_region_exit(nested);
- #else
- app_util_enable_irq();
- #endif
- }
- uint8_t privilege_level_get(void)
- {
- #if __CORTEX_M == (0x00U) || defined(_WIN32) || defined(__unix) || defined(__APPLE__)
-
- return APP_LEVEL_PRIVILEGED;
- #elif __CORTEX_M >= (0x04U)
- uint32_t isr_vector_num = __get_IPSR() & IPSR_ISR_Msk ;
- if (0 == isr_vector_num)
- {
-
- int32_t control = __get_CONTROL();
- return control & CONTROL_nPRIV_Msk ? APP_LEVEL_UNPRIVILEGED : APP_LEVEL_PRIVILEGED;
- }
- else
- {
-
- return APP_LEVEL_PRIVILEGED;
- }
- #endif
- }
- uint8_t current_int_priority_get(void)
- {
- uint32_t isr_vector_num = __get_IPSR() & IPSR_ISR_Msk ;
- if (isr_vector_num > 0)
- {
- int32_t irq_type = ((int32_t)isr_vector_num - EXTERNAL_INT_VECTOR_OFFSET);
- return (NVIC_GetPriority((IRQn_Type)irq_type) & 0xFF);
- }
- else
- {
- return APP_IRQ_PRIORITY_THREAD;
- }
- }
|