123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160 |
- #include "nrf.h"
- #include "nrf_atomic.h"
- #include "nrf_atflags.h"
- #include "sdk_common.h"
- #define FLAG_BASE(flag_index) ((flag_index) / NRF_ATFLAGS_FLAGS_PER_ELEMENT)
- #define FLAG_MASK(flag_index) (1UL << ((flag_index) % NRF_ATFLAGS_FLAGS_PER_ELEMENT))
- void nrf_atflags_set(nrf_atflags_t * p_flags, uint32_t flag_index)
- {
- uint32_t new_value = nrf_atomic_u32_or(&p_flags[FLAG_BASE(flag_index)], FLAG_MASK(flag_index));
- UNUSED_RETURN_VALUE(new_value);
- }
- bool nrf_atflags_fetch_set(nrf_atflags_t * p_flags, uint32_t flag_index)
- {
- return (nrf_atomic_u32_fetch_or(&p_flags[FLAG_BASE(flag_index)], FLAG_MASK(flag_index))
- & FLAG_MASK(flag_index)) != 0;
- }
- void nrf_atflags_clear(nrf_atflags_t * p_flags, uint32_t flag_index)
- {
- uint32_t new_value = nrf_atomic_u32_and(&p_flags[FLAG_BASE(flag_index)], ~FLAG_MASK(flag_index));
- UNUSED_RETURN_VALUE(new_value);
- }
- bool nrf_atflags_fetch_clear(nrf_atflags_t * p_flags, uint32_t flag_index)
- {
- return (nrf_atomic_u32_fetch_and(&p_flags[FLAG_BASE(flag_index)], ~FLAG_MASK(flag_index))
- & FLAG_MASK(flag_index)) != 0;
- }
- bool nrf_atflags_get(nrf_atflags_t const * p_flags, uint32_t flag_index)
- {
- return (p_flags[FLAG_BASE(flag_index)] & FLAG_MASK(flag_index)) != 0;
- }
- uint32_t nrf_atflags_init(nrf_atflags_t * p_flags, uint32_t flags_array_len, uint32_t flag_count)
- {
- uint32_t required_flags_array_len = NRF_ATFLAGS_ARRAY_LEN(flag_count);
- if (required_flags_array_len <= flags_array_len)
- {
- for (uint32_t i = 0; i < required_flags_array_len; i++)
- {
- p_flags[i] = 0;
- }
- return required_flags_array_len;
- }
- return 0;
- }
- uint32_t nrf_atflags_find_and_set_flag(nrf_atflags_t * p_flags, uint32_t flag_count)
- {
- for (uint32_t i = 0; i < NRF_ATFLAGS_ARRAY_LEN(flag_count); i++)
- {
-
- uint32_t first_zero = __CLZ(__RBIT(~p_flags[i]));
- while (first_zero < 32)
- {
- uint32_t first_zero_global = first_zero + (i * 32);
- if (first_zero_global >= flag_count)
- {
- break;
- }
- if (!nrf_atflags_fetch_set(p_flags, first_zero_global))
- {
- return first_zero_global;
- }
- first_zero = __CLZ(__RBIT(~p_flags[i]));
- }
- }
- return flag_count;
- }
- uint32_t nrf_atflags_find_and_clear_flag(nrf_atflags_t * p_flags, uint32_t flag_count)
- {
- for (uint32_t i = 0; i < NRF_ATFLAGS_ARRAY_LEN(flag_count); i++)
- {
-
- uint32_t first_one = __CLZ(__RBIT(p_flags[i]));
- while (first_one < 32)
- {
- uint32_t first_one_global = first_one + (i * 32);
- if (first_one_global >= flag_count)
- {
- break;
- }
- if (nrf_atflags_fetch_clear(p_flags, first_one_global))
- {
- return first_one_global;
- }
- first_one = __CLZ(__RBIT(p_flags[i]));
- }
- }
- return flag_count;
- }
|