123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491 |
- extern "C" {
- (1U << 0) \
- | (1U << 1) \
- | (1U << 4) \
- ))
- (1U << POWER_CLOCK_IRQn) \
- | (1U << RADIO_IRQn) \
- | (1U << RTC0_IRQn) \
- | (1U << TIMER0_IRQn) \
- | (1U << RNG_IRQn) \
- | (1U << ECB_IRQn) \
- | (1U << CCM_AAR_IRQn) \
- | (1U << TEMP_IRQn) \
- | (1U << __NRF_NVIC_NVMC_IRQn) \
- | (1U << (uint32_t)SWI5_IRQn) \
- ))
- typedef struct
- {
- uint32_t volatile __irq_masks[__NRF_NVIC_ISER_COUNT];
- uint32_t volatile __cr_flag;
- } nrf_nvic_state_t;
- extern nrf_nvic_state_t nrf_nvic_state;
- __STATIC_INLINE int __sd_nvic_irq_disable(void);
- __STATIC_INLINE void __sd_nvic_irq_enable(void);
- __STATIC_INLINE uint32_t __sd_nvic_app_accessible_irq(IRQn_Type IRQn);
- __STATIC_INLINE uint32_t __sd_nvic_is_app_accessible_priority(uint32_t priority);
- __STATIC_INLINE uint32_t sd_nvic_EnableIRQ(IRQn_Type IRQn);
- __STATIC_INLINE uint32_t sd_nvic_DisableIRQ(IRQn_Type IRQn);
- __STATIC_INLINE uint32_t sd_nvic_GetPendingIRQ(IRQn_Type IRQn, uint32_t * p_pending_irq);
- __STATIC_INLINE uint32_t sd_nvic_SetPendingIRQ(IRQn_Type IRQn);
- __STATIC_INLINE uint32_t sd_nvic_ClearPendingIRQ(IRQn_Type IRQn);
- __STATIC_INLINE uint32_t sd_nvic_SetPriority(IRQn_Type IRQn, uint32_t priority);
- __STATIC_INLINE uint32_t sd_nvic_GetPriority(IRQn_Type IRQn, uint32_t * p_priority);
- __STATIC_INLINE uint32_t sd_nvic_SystemReset(void);
- __STATIC_INLINE uint32_t sd_nvic_critical_region_enter(uint8_t * p_is_nested_critical_region);
- __STATIC_INLINE uint32_t sd_nvic_critical_region_exit(uint8_t is_nested_critical_region);
- __STATIC_INLINE int __sd_nvic_irq_disable(void)
- {
- int pm = __get_PRIMASK();
- __disable_irq();
- return pm;
- }
- __STATIC_INLINE void __sd_nvic_irq_enable(void)
- {
- __enable_irq();
- }
- __STATIC_INLINE uint32_t __sd_nvic_app_accessible_irq(IRQn_Type IRQn)
- {
- if (IRQn < 32)
- {
- return ((1UL<<IRQn) & __NRF_NVIC_APP_IRQS_0) != 0;
- }
- else if (IRQn < 64)
- {
- return ((1UL<<(IRQn-32)) & __NRF_NVIC_APP_IRQS_1) != 0;
- }
- else
- {
- return 1;
- }
- }
- __STATIC_INLINE uint32_t __sd_nvic_is_app_accessible_priority(uint32_t priority)
- {
- if( (priority >= (1 << __NVIC_PRIO_BITS))
- || (((1 << priority) & __NRF_NVIC_APP_IRQ_PRIOS) == 0)
- )
- {
- return 0;
- }
- return 1;
- }
- __STATIC_INLINE uint32_t sd_nvic_EnableIRQ(IRQn_Type IRQn)
- {
- if (!__sd_nvic_app_accessible_irq(IRQn))
- {
- return NRF_ERROR_SOC_NVIC_INTERRUPT_NOT_AVAILABLE;
- }
- if (!__sd_nvic_is_app_accessible_priority(NVIC_GetPriority(IRQn)))
- {
- return NRF_ERROR_SOC_NVIC_INTERRUPT_PRIORITY_NOT_ALLOWED;
- }
- if (nrf_nvic_state.__cr_flag)
- {
- nrf_nvic_state.__irq_masks[(uint32_t)((int32_t)IRQn) >> 5] |= (uint32_t)(1 << ((uint32_t)((int32_t)IRQn) & (uint32_t)0x1F));
- }
- else
- {
- NVIC_EnableIRQ(IRQn);
- }
- return NRF_SUCCESS;
- }
- __STATIC_INLINE uint32_t sd_nvic_DisableIRQ(IRQn_Type IRQn)
- {
- if (!__sd_nvic_app_accessible_irq(IRQn))
- {
- return NRF_ERROR_SOC_NVIC_INTERRUPT_NOT_AVAILABLE;
- }
- if (nrf_nvic_state.__cr_flag)
- {
- nrf_nvic_state.__irq_masks[(uint32_t)((int32_t)IRQn) >> 5] &= ~(1UL << ((uint32_t)(IRQn) & 0x1F));
- }
- else
- {
- NVIC_DisableIRQ(IRQn);
- }
- return NRF_SUCCESS;
- }
- __STATIC_INLINE uint32_t sd_nvic_GetPendingIRQ(IRQn_Type IRQn, uint32_t * p_pending_irq)
- {
- if (__sd_nvic_app_accessible_irq(IRQn))
- {
- *p_pending_irq = NVIC_GetPendingIRQ(IRQn);
- return NRF_SUCCESS;
- }
- else
- {
- return NRF_ERROR_SOC_NVIC_INTERRUPT_NOT_AVAILABLE;
- }
- }
- __STATIC_INLINE uint32_t sd_nvic_SetPendingIRQ(IRQn_Type IRQn)
- {
- if (__sd_nvic_app_accessible_irq(IRQn))
- {
- NVIC_SetPendingIRQ(IRQn);
- return NRF_SUCCESS;
- }
- else
- {
- return NRF_ERROR_SOC_NVIC_INTERRUPT_NOT_AVAILABLE;
- }
- }
- __STATIC_INLINE uint32_t sd_nvic_ClearPendingIRQ(IRQn_Type IRQn)
- {
- if (__sd_nvic_app_accessible_irq(IRQn))
- {
- NVIC_ClearPendingIRQ(IRQn);
- return NRF_SUCCESS;
- }
- else
- {
- return NRF_ERROR_SOC_NVIC_INTERRUPT_NOT_AVAILABLE;
- }
- }
- __STATIC_INLINE uint32_t sd_nvic_SetPriority(IRQn_Type IRQn, uint32_t priority)
- {
- if (!__sd_nvic_app_accessible_irq(IRQn))
- {
- return NRF_ERROR_SOC_NVIC_INTERRUPT_NOT_AVAILABLE;
- }
- if (!__sd_nvic_is_app_accessible_priority(priority))
- {
- return NRF_ERROR_SOC_NVIC_INTERRUPT_PRIORITY_NOT_ALLOWED;
- }
- NVIC_SetPriority(IRQn, (uint32_t)priority);
- return NRF_SUCCESS;
- }
- __STATIC_INLINE uint32_t sd_nvic_GetPriority(IRQn_Type IRQn, uint32_t * p_priority)
- {
- if (__sd_nvic_app_accessible_irq(IRQn))
- {
- *p_priority = (NVIC_GetPriority(IRQn) & 0xFF);
- return NRF_SUCCESS;
- }
- else
- {
- return NRF_ERROR_SOC_NVIC_INTERRUPT_NOT_AVAILABLE;
- }
- }
- __STATIC_INLINE uint32_t sd_nvic_SystemReset(void)
- {
- NVIC_SystemReset();
- return NRF_ERROR_SOC_NVIC_SHOULD_NOT_RETURN;
- }
- __STATIC_INLINE uint32_t sd_nvic_critical_region_enter(uint8_t * p_is_nested_critical_region)
- {
- int was_masked = __sd_nvic_irq_disable();
- if (!nrf_nvic_state.__cr_flag)
- {
- nrf_nvic_state.__cr_flag = 1;
- nrf_nvic_state.__irq_masks[0] = ( NVIC->ICER[0] & __NRF_NVIC_APP_IRQS_0 );
- NVIC->ICER[0] = __NRF_NVIC_APP_IRQS_0;
- nrf_nvic_state.__irq_masks[1] = ( NVIC->ICER[1] & __NRF_NVIC_APP_IRQS_1 );
- NVIC->ICER[1] = __NRF_NVIC_APP_IRQS_1;
- *p_is_nested_critical_region = 0;
- }
- else
- {
- *p_is_nested_critical_region = 1;
- }
- if (!was_masked)
- {
- __sd_nvic_irq_enable();
- }
- return NRF_SUCCESS;
- }
- __STATIC_INLINE uint32_t sd_nvic_critical_region_exit(uint8_t is_nested_critical_region)
- {
- if (nrf_nvic_state.__cr_flag && (is_nested_critical_region == 0))
- {
- int was_masked = __sd_nvic_irq_disable();
- NVIC->ISER[0] = nrf_nvic_state.__irq_masks[0];
- NVIC->ISER[1] = nrf_nvic_state.__irq_masks[1];
- nrf_nvic_state.__cr_flag = 0;
- if (!was_masked)
- {
- __sd_nvic_irq_enable();
- }
- }
- return NRF_SUCCESS;
- }
- }
|