123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179 |
- #include <nrfx.h>
- #if NRFX_CHECK(NRFX_PRS_ENABLED)
- #include "nrfx_prs.h"
- #define NRFX_LOG_MODULE PRS
- #include <nrfx_log.h>
- #define LOG_FUNCTION_EXIT(level, ret_code) \
- NRFX_LOG_##level("Function: %s, error code: %s.", \
- __func__, \
- NRFX_LOG_ERROR_STRING_GET(ret_code))
- typedef struct {
- nrfx_irq_handler_t handler;
- bool acquired;
- } prs_box_t;
- #ifndef USE_REGISTER_UART
- #define PRS_BOX_DEFINE(n) \
- static prs_box_t m_prs_box_##n = { .handler = NULL, .acquired = false }; \
- void nrfx_prs_box_##n##_irq_handler(void) \
- { \
- NRFX_ASSERT(m_prs_box_##n.handler); \
- m_prs_box_##n.handler(); \
- }
- #else
- #define PRS_BOX_DEFINE(n) \
- static prs_box_t m_prs_box_##n = { .handler = NULL, .acquired = false };
- #endif
-
- #if defined(NRFX_PRS_BOX_0_ADDR) && NRFX_CHECK(NRFX_PRS_BOX_0_ENABLED)
- PRS_BOX_DEFINE(0)
- #endif
- #if defined(NRFX_PRS_BOX_1_ADDR) && NRFX_CHECK(NRFX_PRS_BOX_1_ENABLED)
- PRS_BOX_DEFINE(1)
- #endif
- #if defined(NRFX_PRS_BOX_2_ADDR) && NRFX_CHECK(NRFX_PRS_BOX_2_ENABLED)
- PRS_BOX_DEFINE(2)
- #endif
- #if defined(NRFX_PRS_BOX_3_ADDR) && NRFX_CHECK(NRFX_PRS_BOX_3_ENABLED)
- PRS_BOX_DEFINE(3)
- #endif
- #if defined(NRFX_PRS_BOX_4_ADDR) && NRFX_CHECK(NRFX_PRS_BOX_4_ENABLED)
- PRS_BOX_DEFINE(4)
- #endif
- static prs_box_t * prs_box_get(void const * p_base_addr)
- {
- #if !defined(IS_PRS_BOX)
- #define IS_PRS_BOX(n, p_base_addr) ((p_base_addr) == NRFX_PRS_BOX_##n##_ADDR)
- #endif
- #if defined(NRFX_PRS_BOX_0_ADDR) && NRFX_CHECK(NRFX_PRS_BOX_0_ENABLED)
- if (IS_PRS_BOX(0, p_base_addr)) { return &m_prs_box_0; }
- else
- #endif
- #if defined(NRFX_PRS_BOX_1_ADDR) && NRFX_CHECK(NRFX_PRS_BOX_1_ENABLED)
- if (IS_PRS_BOX(1, p_base_addr)) { return &m_prs_box_1; }
- else
- #endif
- #if defined(NRFX_PRS_BOX_2_ADDR) && NRFX_CHECK(NRFX_PRS_BOX_2_ENABLED)
- if (IS_PRS_BOX(2, p_base_addr)) { return &m_prs_box_2; }
- else
- #endif
- #if defined(NRFX_PRS_BOX_3_ADDR) && NRFX_CHECK(NRFX_PRS_BOX_3_ENABLED)
- if (IS_PRS_BOX(3, p_base_addr)) { return &m_prs_box_3; }
- else
- #endif
- #if defined(NRFX_PRS_BOX_4_ADDR) && NRFX_CHECK(NRFX_PRS_BOX_4_ENABLED)
- if (IS_PRS_BOX(4, p_base_addr)) { return &m_prs_box_4; }
- else
- #endif
- {
- return NULL;
- }
- }
- nrfx_err_t nrfx_prs_acquire(void const * p_base_addr,
- nrfx_irq_handler_t irq_handler)
- {
- NRFX_ASSERT(p_base_addr);
- nrfx_err_t ret_code;
- prs_box_t * p_box = prs_box_get(p_base_addr);
- if (p_box != NULL)
- {
- bool busy = false;
- NRFX_CRITICAL_SECTION_ENTER();
- if (p_box->acquired)
- {
- busy = true;
- }
- else
- {
- p_box->handler = irq_handler;
- p_box->acquired = true;
- }
- NRFX_CRITICAL_SECTION_EXIT();
- if (busy)
- {
- ret_code = NRFX_ERROR_BUSY;
- LOG_FUNCTION_EXIT(WARNING, ret_code);
- return ret_code;
- }
- }
- ret_code = NRFX_SUCCESS;
- LOG_FUNCTION_EXIT(INFO, ret_code);
- return ret_code;
- }
- void nrfx_prs_release(void const * p_base_addr)
- {
- NRFX_ASSERT(p_base_addr);
- prs_box_t * p_box = prs_box_get(p_base_addr);
- if (p_box != NULL)
- {
- p_box->handler = NULL;
- p_box->acquired = false;
- }
- }
- #endif
|